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(57) Abstract: A design method for industrial products using a clothoid curve, wherein (A), the route of the motion of a mechanical 
element is designed by using a three-dimensional curve (called the three-dimensional clothoid curve) in which each of a pitch angle 
and a yaw angle in tangential direction is given by the quadratic of a curve length or curve length variables and (B). the route of a 
tool or the profile of a work is expressed by using a three-dimensional curve (called the three-dimensional clothoid curve) in which 
each of a pitch angle and a yaw angle in tangential direction is given by the quadratic of a curve length or curve length variables, and 
the motion of the tool is controlled by the three-dimensional curve. 
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[068] *Lfcffi«i: tK U =T> £ £*^f0o 
[069]j££^ALf::0o 

[H70]»H$*Lfc3^7c<7PV«< Kfi^^^-rHo 
[071]±j$$;Kfcffli§l£^-f0o 

[H72]«.ffl«a)J&jSi35x&a)»»iffiltsi:ft*/ca)i8«^-r^7^o 
[073] tMtfrJftJ^;£ xSHo 
[H74]fi£*<DX^^-r>ft«**-rik«Ho 

§6m*nil*1rZtzl/><DWttk<DflM 

[0051] A. ^PV^ Ka^^ffll^I$S B D B 0lSI+^ 

INT. 1. 3*tg*PV^ KfflfSM>3£*£1#«L 2. 3^PV^Kii 
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[0052] 1 . 3^7c>? □ v-r FmmojzmtftWL 

[0053] (1-1)3 ^tc<7 PV^ K<D** 

^PV-T Kfl^(Clothoid curve) I*. )\s—=L—G>$%M(Cornu' s 

[0054] f§0^#^Ktlcffi^L-C^^2^7u(D^P Kffifftl*. (2&te 

o 

[0055] [»9] 

P = P 0 + JV^ds =P 0 +hj o S e^dS, 0 < s < h, 0<S = ^-<1 

(l-i) 

<j> = c 0 +c lS + c 2 s 2 = (f> 0 +^ V S + ^ U S 2 (1-2) 
[*10] 

P = x + jy, j = V r l (1-3) 

[ftll] 

?o = x o + jy 0 (1-4) 
it. *<D%)Mm h;u) T?*^ 0 

Ml 2] 

= cos ^ + jsin ^ (1-5) 
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[0056] &m~fe^xm^tz&i1&<D]&&frP><D&£$:stL. *<D±& ($££fr£ 
m^WMZ) Zhk-f&o s £h-eilJofcfit£S-e^b-ro Sli«l^7c 

[0057] ?nV>T Kffl3^(7>^l*. iC(1-2)-C^LfcJ:5lc. 

0 1 2 

0,0, 0 (£-;*5C<D^-efcy. ^b^iioffih^py^ 

0 v u 

[0058] J^±<DPj££3#7ElctMLT. 3 &te>7 □ y-f Kffl«M>:*£fE£o 

[0059] 3^PV^ Kft^^mT(DiC-t:^ttt- 
[0060] [^Jt13] 



p = p 0 + J q S uds = P 0 + h J q S udS , 0 < s < h , 0 < S = — < 1 



h 
(1-6) 



u = E k %S a (i) = 



cos /? - sin/? 0 
sin/? cos/? 0 
0 0 1 



cos# 0 sin a 

0 1 0 
-sin« 0 cosa: 



a - a 0 + a : S + a 2 S" 



^ = b 0 +b!S + b 2 S^ 



(1-8) 
(1-9) 



cos/? cos a: 
> — -l sin/?cos# 

-sin or 
(1-7) 



[»14] 
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X 




x o 


p = < 


y 


>, ?o=< 


yo * 




z 

L J 







(1-10) 



to i , j , k tt-ttL-^+L. x$fi. &tf z«^|R](DJiitiK* h/u-e* 

[0061] uiij^Pizfcit<sfi^(D^^[S]^^-rm(i^^ h/u-efcy. sc(i-7)iz,fco 

X5-^Z>*1& 0 iC(1-7)|CfcL^r. E k ^{;r«7h'J^Xtfey, 0 3 

l=jj***L*J:5l=, *;h,^*u kill (ztt) **3y©||ftiS©IHE&i; j tt 
(y*) &fr>V(Dfkma<D\B\&$:mfr>LX^Z> 0 iu#£ 3- (yaw) mm. '&% 
ZtfyT (pitch) [H$5 £l^ 0 jC(1-7)[*. i $01 (x«) 

*-fj$ft (ytt) *3byiz or £1+111 U Lfr&<DiE>\zw$& (ztt) 

o 

[0062] -r^+p*>. 2^7n(Dii^ii. tomnmmijfo&m-tmit^v h/ue j *i*. x 

[0063] 3Sfc5c*PVf KffittlcfcHTI*. bJWtfvTfta&XfB-fk 
0 te^tl^ftiC (1-8) (1-9) iz^f cfc ? 13. fiUK^&S 2 $ZjRX*5- 

[0064] m±a>iClz^:or^L^cr<!:<. 3^tc<7P v-T Kft^li rji^[p](7)t 0 
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j t^mzti&o 

[0065] P ^f>^*^>-0(D3^7U^P V>T KffiHl*. 

0 

[*15] 

a 0 , a ls a 2 , b 0 , b ls b 2 , h (l-ll) 



0 2 

[0066] (1-2) 3^7C^P V-T KffilSLt(D:7/U*SMil£ffi* 

ffm<7> 3 ;*7ufilWfc t^/^^-^t LTR(t)-eaf -So «f# 

[0067] dsf£ltM^fe^>fiil±(D2^(Dffi^im^^ h/UdR(s) 0f&*Hit$fft*ds£ 
dsi:dt(D^lc|*^(D (2-1) sCcDP^fe^o — ^tlcJc-S 

[0068] [ft16] 



ds = |dR(t)| 



dR(t) 



dt 



dt 



R 



= VR • Rdt 



(2-1) 



[0069] m&mu^ hjuu(t)it^mo>mm^ h/KiR(t)*at^bLf=ta>-c*-5 
*np> (2-D a&itm-t&t* (2-2) avmfr-e&o 

[0070] [»17] 



u(t) = 



dR (t) _ dR (t) 



R 



|dR (t)| 



ds 



R(t) 



(2-2) 



[0071] mfiS^^ h/K7>^b»du|COt^r#^^o IS 5 li^fe)**!!^ 

h)\s<Dmtm&7jkTt 0 m.momG\zmm.*miLmt>*t£i\fri±dyx(x)= {o,o,o 
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fti-Ztm&Mmu- du=0*q# f>^^>C<b:*NP>^0^^7!)N-C!fc^ o C 0) 

hJ\s<Dmtmdu&&mitLtzlb<Drfm®.±}lk1l%'<<7 h/Un(t) O 

JMfc^Sjfft** h/un(t)i* (2-3) ie-e^^^-So 

[0072] [»18] 

nrn _ u(t) 

n(t> - huTTT (2 ' 3) 

[0073] ^^[p]l*A^}t^|pl^|p]L^c<b#(D^[p]^iEi:-r^o <fc y MfcW 

t^-ett. h/uiu£:JMittf*'<* h/nj(t)<t-e#&¥®rt-t?. m&mm 
*v h;uu(t)^e,jsB#B+**py(c90jsniKLfc^iR]$m&^^^ h/u 

n(t)(DiE^[S]<b^«-r^o 
[0074] £fc. ttfcll'** h/Ub(t)(*. JUfctt*** V)Ui(X) tam^M^ h 

[0075] [»19] 

b(t) = u(t) x n(t) (2-4) 

[0076] ^«$*tfc^ft«^<^ h/Uu(tk m^L±m^<7 h/Un(tK ft&ISK* 
h/Ub(t)^3 0(D^^ h/KD3|§{u(t), n(t), b(t)} <i: Lfc=t<7>£. figKDte 
ffiR(t)|zfclf£?/u;MHf (Frenet Frame) <bP?^o 

[0077] ttltr. ft«©«3lHz?&o-CJ|ifeft«^^ h/KDffij&<£*l^-e*£ffi*K 

icoixr^^o 3^7c(zfc(t^fl^ii. (2-5) iC-tr^tt^H^o 

[0078] [»20] 

R(t)x R(t) 
K ( t ) = (2 . 5) 

||R(t)|| 

[0079] J^±T^*$^^3^7ua^|zfclf^,»^fi<j/j:M|zotNr. 32fc7G*nv-f 
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[0080] em<D3^7c^p v-y Ftempw&mz.tzt&m&.mm'O h/ujcsm, 
(2-2) xe<fc<ck (2-6) xe-e^-rct^-e^-So 

[0081] [»21] 



u(S) = 



P'(S) 
P'(S)| 



(2-6) 



[0082] * h/Uu(S)l*3^7C^P V-f Kffi«0>3£*^(1-7) (1-8) 

0-9)^#j*-r^<b^(D(2-7)sC(D^-ea-rc<bt-e^^o C 

[0083] [»22] 



u(S) = 



COS /?(S)cOS «(S) 

sin /?(S)cos or(S) 
- sin a ( S ) 



(2-7) 



[0084] 3#7C? P V-T KfflgkD&IU^ h/Uu (S) (7)ffi^S^^S-e(D 1 Pg«#L£: 

4, (Dli (2-8) s£-C. ^(7>*# £ li (2-9) £ ft&o 
[0085] [»23] 



u'(S) = 



-«r'(S)cos / ^(S)sina(S)-^ , (S)sin ^(S)cosa(S) 
- or'(S) sin ^(S)sin a(S) - /?*(S)cos /?(S) cos a(S) 
-a'(S)cos ctr(S) 



(2-8) 



||u*(S)|| = V«'(S) 2 + ^'(S) 2 cos 2 a(S) 



(2-9) 



[0086] h;Un(S)|z-DlN-C#^.€>o 3&7cffitSia>£«'<* h;u 

I*. (2-3) j&VBiZttZ>(DV3#.7i<7n V*f KffifSKD&fft"** MUI*. ( 
2-10) :£-e*£*i<g>c<!:lz£:£ 0 
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[0087] »24] 



n(S) = ^ (S) 



\m\ 

'- «*(S)cos^(S)sina(S) - /?(S)sin ^(S)cosor(S) 
-a , (S)sin / ff(S)sina(S) + ^'(S)cos^(S)cosa(S) 
-o;'(S)cosa(S) 

(2-10) 



V«'(S) 2 +^'(S) 2 cos 2 a(S) 



[0088] h;Ub(S)|zoi,\T(£, (2-4) (2-7)itO)f ii^^^ 

HUu(S) i: (2-10)iC(7)Wi±}S^^ h;Un(S) t<Ot Ltz 0 

[0089] [t&25] 

b(S) = u(S)x n(S) (2-11) 

[0090] «&[cffiifMzoi,N-C-e&6#\ (2-5)S**B-r*i:(2-12)S:-C*-fr*, 
[0091] [»26] 

y(S) _ il P '( S ) x P "( S >il = H S >il _ V^(S) 2 + /?'(S) 2 cos 2 «(S) 
||P'(S)|| 3 h h 

(2-12) 

[0092] JiLt^y. 3^7c^PV-f Kffl*±<D«-^i(za3(t^7;u^ai«i:ffl*/c$ 
[0093] ( 1 - 3 ) ft 3 &tc? P V -f KffiS!|(Z)£j& 

[0094] tJH^P 3^7u^PV^ hl^PV-f K/*^*— 

s e 

. h,a ,a ,a ,b ,b ,b (D70(Dflt-C:^-i>3^7c>7P V-T KflgJC <h-T£ 

0 12 0 12 1 

o *(Dt£. titHmUna^ TIB© (2-13) (2-14) ^"e^^^L^o 

[0095] [»27] 
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«i = a o +a!S + a 2 S 2 ( 2 -i3) 
A =b 0 +b 1 S + b 2 S 2 (2-14) 

[0096] C(7)3^5c^P V-f Kffi«g£l^ MtlRl^ATO^jc^QV^ 

Kfl«c i=fcivci** *&j££p' p' ^tnt, -t+L-r+LP' = 

2 s e s 

P . P' =P t^^o *^rft^ShlCOLNT#^^^ |5|DX^$-efe^C<i: 

e e s 

1 2 

2 1 

1 112 

2 2 

[0097] [»28] 

a 2 (S) = ai(l-S) + «- (2-15) 
^ 2 (S) = ^(1-S) (2-16) 

[0098] Cft£(D:£l;*g3I-r£<h. Tl3(Z> (2-17) (2-18) j&-em£*i& 0 
[»29] 

«2( s ) = ( a o + a i + a 2 + ^) ~ ( a i + 2a 2 )S + a 2 S 2 (2-17) 
/? 2 (S) - (b 0 + b, + b 2 )- (bj + 2b 2 )S + b 2 S 2 (2-18) 

[0099] ^*l\z&^xm&/^*—$rfj£$;Z><D-C\ ffilfeSiC <D5 P V-T J* — * 

2 

h ' , a ' , a ' , a ' , b ' , b ' , b ' I*. fi*§C <D/i?* &m 

0 12 0 12 1 

l^T. (2-19) ie-e*-l±^Zi:IC7£j:-i, 0 
[&30] 
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Ps = Pe 

a 0 =a 0 +a l+ a 2 +;r 
a l = -( a l + 2a 2> 

a 2 = a 2 

bo = b 0 +bi +b 2 

bi = -(b 1+ 2b 2 ) ^ 2 ' 19 ) 
b 2 = b 2 
h' = h 



[0100] c©H«sc*ffli^ttr*. hi:**** »«-eiPi#^jfift3*7c^p v-r Kffl 

[0101] (1-4) 3&ro*PV*r KfflfR©#SI 

irH^P 3^P7^f Kffi«a>?PV-r K/^y-$rjb< 

1 2 

. h,a,a,a,b,b,b ©7o<DflfC***3^7c^ P Kftt&C 

0 12 0 12 0 

1 2 0 
dm 12 

[0102] #ll£jftfcffi|§G>?^ j^P ^^^-T^ffl^C (COlNT#^.^o fl^Sh 

lzoi^T#7l&<!:. 3^tc<7P V-T Kft«<D3£*«fey. fl^C (Dffigifth lift 

1 1 

0 0 d 1 

0 0 1 1 

[0103] [»31] 

Si = S d S o (2-20) 

[0104] o*y. ffl^C (D^HIIk^ a . £ £ft|£C 0)&|g|llt&ft a . £ t<Dm\~ 

0 0 0 1 1 1 

[0105] [»32] 
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a 1 (S 1 ) = ^ 0 (S d S 0 ) 

A(Si) = /?o(s d s 0 ) 



(2-21) 



[0106] Z*ih><DjRltmm? Z>t. TE<D(2-22)5S-e***i£< 
[0107] [»33] 



2 C 2 



a^S) = a 0 + ajS d S + a 2 S d S 



2 C 2 



A(S) = b 0 +b 1 S d S + b 2 S d z S' 
[0108] ai^ot^^l^f^^t. 



a ' . a ' a ' b ' , b ' b ' I*. 

0 12 0 12 



(2-23) CtlCft^ 



[»34] 






a o 


- a o 




aj 


= a , S d 




a' 2 


= a 2 S d 2 


< 


bo 


= b 0 




bj 


= b iS d 




b' 2 


= b 2 S d 2 




h' 


= hS d 



(2-22) 



(2-23) 



[0110] ^ic^sij^p^^^tt-'&ffl^cizo^r^^^o ffl«c(zotx-cr*. 1-3-e 

m 2 2 

ffl I ^tz £ Jjfi^fr-fc!: £ CI t ic J; o X "C ; £ £ . 

[0111] aict^$, »«A<Hi:riRi*A<ifi3£i:ft«*ffi«c' t?z> 0 z 

0 0 

(Dfi^±icfc^r^su^p I*. p=c d-s)tl$ti§o c^tiic £^p 

m m 0 d 0 



2 



<h*#£. M^l^ll:-eIS]^J!)^Wd:fi^llC7£i:oTL^^o 1-3 
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2 2 



[0112] C©^C^PVYhM7^-!5!h", a", a", a", b" , b" . b" It. 

2 0 1 2 0 1 2 

tf)/^^— TbE<£> (2-24) 5£-eS-t±&o 



[0113] [1&35] 



a 0 




a? 




a" 2 




bo 




bl 




b" 2 




h" 





a 0 + a^ + a 2 S d 
= (l-S d ){a 1 + 2a 2 S d } 

= a 2 (l-S d ) 2 

b 0 + b x S d + b 2 S d 
= (l-S d ){b 1 + 2b 2 S d } 

= b 2 (l-S d ) 2 
= h(l-S d ) 



(2-24) 



0 dm 

1 2 

[0114] (1-5) 3^7C^PV>r Kffl^(7>^ 
[0115] (a)fii^(D^tt 

□ v>r Kffl^^ii^^ii^ict. *<D-Dtj:gB\zt$^xmm. mm. &m 
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[0116] (b)Jlffltt 

[01 1 7] (c) gtfiTffilft <t tf>g^t£ 

m« ■ nan ■ teCft^&^cMiM^i*. ^pv^ K/^*-$<z>i^<o 

e> *vt l * & is 35 £ 7%m ? & c: t #-c ; # & . 
[0119] -r^*>. Etic*n£>;h,-ci,^2#7c^p y-r K£^#>r. naiHfMStftfc^ 

[0120] (d)MiIL<D&£ 

[0121] ^PVf KAtt£ Lra^Lfc^iSlc^S ■ SNS^IfI ■ ffl^tOflt 

-r^Jb*>> ffll&<D/^*-*S|z2>h£LT. (1-7), (2-10) (2-1 2) 3* 
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[01 22] ( e ) mmumo)^ y ^-r $ 

Oilft0>±£flt*<A: * s * fc i* lEfcte $ *Lf=* * s t? y . ffit&©#est I* 

[0123] 2. 3&tc>?P V-T Kffif&£m*fc*tffl& 

[0124] (2-1) »&fr£8Nft<D»5*«j*M* 

[0125] 2*©3&7G*PV>f KWffl)^tib^l«$tLt^§Ctli 

[0126] [»36] 
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Pxi(l) = Px i+1 (0) 

Pyi(i) = Py i+ i(0) 

P Zi (l) = Pz i+1 (0) 
«i(l) = a i+ i(0) 

A(i) = # + i(0) (3 " 1} 

tanyj(l) = tany i+1 (0) 
^i(l) = ^ i+1 (0) 

[0127] c*u*> tm&-em&'<5 t-)i,tm&'«7 k/k &mta, 

[0128] [2&37] 

Px = Px i + 1 (0) 

Py iO) = Py i+ i(0) 

Pz = Pz i + 1 (0) 

cos[ - a i + x (0)] = 1 

cos[ - /? i + i(0)] = 1 (3 " 2) 

tan 7 = tan y i + 1 (0) 
^i(l) = * i+ i(0) 

[0129] CC-e ££1::. 
[»38] 

cos[«i(l)-a i+1 (0)] = l 

[»39] 

tany i (l) = tany i+1 (0) 
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[&40] 

tany i (l) = tany i+1 (0) 

gj (1) = gj±i (0) 
(1) cos «i (1) (0) cos or i+1 (0) 

v a'i (0) = a'i+i (0)/?'i (1) 

[0130] [»41] 

P Xi (l) = Px i+1 (0) 

Pyi(i) = Py i+ i(0) 

P Zi (l) = Pz i+1 (0) 
cos[ cc\ (1) - a i+l (0)] = 1 

cos[A(l)-A + i(0)] = l (3 " 3) 
«i(l)^i + i(0) = ai' +1 (0)#(1) 
Ac-i(l) = /r i+1 (0) 

[0131] (3-3)iClcfc^T. S^(D3iCI*fiS(Z)3a^ < tt. &(&2^I*1£^|£](E>5S^ 
14. %.<D 1 xCI*)±^[S](Z)-^ »&(D:i£l*ffi^<DiI^14£7FL-Cl^o G 2 
^^M^^fT^lCl*. 2*03^07^ Kato^0iM^-e(3-3)ie0 
7 0(D^^^Jifcf i&^&£o 

[0132] G 2 ^ (GI*Geometry(DIi^) lz-Dl,NT*i£-f £o 111 8 (*G 'mWiteffim 

[0133] G 0 mmtl*2*<D3%.7t<7n V-f Kffi«*<*(Dtt]|&-etiffij&<-»-*- £ d £ 

l^;h,£C 0 ~C 2 5SM<h*#glE(D^n V'f Kffi^-effll^«oft&G°~G 2 jii^ 
[0134] [*1] 
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C 0 : M 


G 0 : itLW 


c 1 : -Yku^mm 


g 1 : m&tsm 


c 2 : -vrnftom 


G 2 : 8&fc¥ffi (StilfcK ft* i 



[0135] 2*a>3^7U^PV^ Kffi«<WiiStt£#2.fc£#l::* C°^C 1 ^C 2 . G° 

G'att-CttftlR^lRlfclW-St-r+LliJ: 

[0136] G 2 mffi-eit&f&w-m (&m) £-sfr£-t±&„ mm^wtitm 9^2*1% 
i;fc^t^^iRi^iitfe§A^tt¥ss 1 , s 2^mm<Dm^7jkLx 

iri) si;a¥^-si^-i±^c<t^G 2 iSM^jifcf^ic7£j:^ 0 

[0137] (2-2) ^ttftftftJT^JG 

[0138] (a) ffi^<Z>/^^-£h, or, 1*0 3 &7t<7 P V-f Kffi«£#l± 

£-feK ^(7>iM^t:\ (3-3)S$3tf=-r<fe^l^<D3^7c^PV-r KflH»©/<7 

©»ffif*a!«-C*y. Z*i£IIK#£n*#o CtD^^lZcfc^l^ *i*&JI2tfc<D 
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[0139] (b)^m%izzhtz&mt)mu<Dmm&ttj:&&?\z > 3^pv^ka 

^icl*. (3-3) iC^jWc-T <fc a icffl^/^ > £jfc5lir£S+3?¥JIII* (a) £ 
[0140] ±|B(b)(D^fi?|coiNr. I+Jt¥;££l¥^lciEiz!rf £o M< ^tmmmit 

(3-3)^. fc&lM*^(Z>-S& 

[0141] Kjfc^ti&Rgiiizjjx-c. «i3MM*<Dfti«<b u **u::ji^5»<Dffii§ 
/^*-*£**n/^*-< $t urig^-r+L(i<fe^o fill a (i. ffl^cD^tt 

[0142] ±IBa>«yjSLJR*ti-#$3e^fzJRm$1i-*fc«)f3tt. itl±fl)i*^ 
3?-c**o sfJf©36*£»i-*\ JX]fc£jl#)£fe#>lz v **a/^*-$lcoi^ 

> - * £1#1f L T . iyji L JK3&S1- JKDfcJJBffi £ f 3 d i: & £ „ 

[0143] fc-SLM*. jSfcf^^tfijm^fr^-^lcJifcf ©"CliS: <. Ili#gr#5££ 

■CfeiftlfairftlSl^lRlA^-Si-rScfca^WraLfcft-C. H2STEP£ LT&« 
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[0144] (2-3) 3#tc>7P Kffi«£m*fc«ra&0>H!fi0!l 
[0145] (a)ffilH3ja>3fE*i 

[0146] 3^tc^ P V-T FW£\<D&*(DlM*lt LXlt. ttH»fc<DilllB]£l6#3& 

G 2 il^<b[i. 2*(D3^7n<7P Kft^^(DiM^-C<iB. &«*IrU >£ 
[0147] (b) G 2 iltt&ffira<Dft# 

[0148] fgjm^3-D©j^P={ Px, Py, Pz}, P = { Px, Py , Pz}, P={ Px, Py 

1 1 1 1 2 2 2 2 3 3 

3 3 

i2li^P, P, P(D3^tu^p y*r K«H*^-r, £P, PH£«&Alg$ffi 

12 3 12 
1 2 3 2 1 

7^— ^a0, a1 , a2, bO , b1 , b2 , h „ flglC <D/*=7* — £a0 , a1 , a2 , 

1 1 1 1 1 1 1 2 2 2 2 

bO, b1 , b2, h(D14ffl£:££, i2l«KWf=TfC < SX^^X^ 'J 

2 2 2 2 

MlfflgtfMifc^o &lc*£^j£P r(*tefilzoi,NT3o. tea** h/uizo^r 

2 O n HM5il*©SM i Fa>5Sj&<*# £ <b ^|S] IZO INT 2 7 1@J& y 3iO 
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2 

<Dft#*«JA?>L*#iCi:*ftljB[<J!>»^L< Lt=o £fc> 

[0150] {&K<D*ttKol,>T#a.££* TIB0) (4-1) (4-2) (4-3) iC<7)30 

A^UltOo (J2lTS«l»i<3fr«o ) 
[»42] 

Px; + h; J o cos(a0i + aljS + a2 i S 2 )cos(bO i + bljS + b2 i S 2 )dS - Px i+1 = 0 

(4-1) 

Pyi +hj ^cos(a0 { +al i S + a2 i S 2 )sin(bO i +bljS + b2;S 2 )dS-Py i+1 = 0 

(4-2) 

Pz i + h j J 1 (- sin( aO i + al i S + a2 i S 2 ))dS - Pz i + 1 -0 

(4-3) 

[0151] &|R^|nHCOl*T#*.<&£ (4-4) (4-5) 0)2.'D<D3£tfm.V±L'Oo 

[&43] 

cos(a0i + alj + a2j - a0 i+1 ) = 1 (4-4) 
cos(b0i + bl; + b2j - b0 i+1 ) = 1 (4-5) 

[0152] ffi*«a>*#SlzoivCI** %.<Dj£(4-6)tff&i)±' Do 
[»44] 



AT i (l)- K - i+1 (0) = 0 



(4-6) 
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[0153] mm^mmxfa'O h/unizo^r#^.^ 0 3^pvt ^mmomm^ 

1 h/Unli. (2-10)sC-C!*^tL^ o 
[0154] CCt3^PV^f Kffi^&g^-S? h/UuCD^<bl^*ilC[Hlfe^fflLNr 
. h/Un£#*_T<5*<?>„ ^DW^^lS] (1,0,0) iz&LT. ^>±^ 

;£iS]£5lifcr£ffl^T (0,cosr,-sinr) titttl>„ zti&mmtmc 

J: ^ lc[s]f5$-Er-5> ^ . ?£^n[*iC (4-7) (OJ: ? lc^$^<5„ 
[0155] [g&45] 



cos a(S) 0 sin «(S) 

0 1 0 

- sin a(S) 0 cos a(S) 



cos y^(S) - sin /?(S) 0 
n(S) = sin /?(S) cos /?(S) 0 
0 0 1 

- sin y cos J3(S) sin a(S) - cos / sin /?(S) 
= <{ - sin y sin y?(S) sin a(S) + cos y cos /?(S) 
— sin y cos ec(S) 



0 

cos / 
- sin y 



(4-7) 



[0156] (2-10) (4-7) jZ$m£?&t. sinr, cosrl* (4-8) :£|z*fj£ LTl^ 
[0157] [^46] 



sin y — 



cos y = 



or'(S) 



V«"(S) 2 + >fl'(S) 2 cos 2 a(S) 

yg'(S)cos g(S) 

V«'(S) 2 + /?'(S) 2 cos 2 a(S) 



(4-8) 



[0158] o£ y . 3£(4-8) J; y . 3;*tc>7 □ V-T KMFhI lc It -e (D jS^M 
[0159] [»47] 



tan / = 



a'(S) 



^'(S)cos a(S) 



(4-9) 
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[0160] o^y&ttiifre jZ(4-w)-e&&^ttffr>fr& 0 

[0161] [#48] 

tan ^j(l) = tan n+iW (4-10) 

[0162] CCC^blC. 

mm 

cos[ai(l)-a i+1 (0)] = l (4-11) 

d t zmmiz^ttz tmwa (4-1 o) i*. TBa>*ttsc (4-12) 

xb^o o*y. aj«31tt-e***#f*(4-i2)ic-e**, 

a'i (0) = (0)^', (1) (4-12) 

[0163] )£±&3zklsb&tm®\^ffimttML<D&$:mV. froG 2 iI^<h&&<fc?&3M* 

[0164] [#51] 

P Xi (l) = Px i+1 (0) 

Pyi(i) = py i+ i(0) 

Pzi(l) = Pz i+1 (0) 
cos[ofi(l)-a i+1 (0)] = 1 
cos[^(l)-A +1 (0)] = l (4 " 13) 
^(l)A' + l(0) = «/ +1 (0)A'(l) 
^(1) = «r i+1 (0) 

[0165] &±<fcy* **D#a1 , a2, b1 , b2 , h , aO , a1 , a2 , bO , b1 , b2 , h 

111112222222 

tf>12<!lc*tL-C. gzi*3£l*TtZ<D-\2mtfJ&V±L'DZ£tffr>fr%o (£P Kfclf 

3 

S«a&*lRllHHEfc£a . Pt+Zo ) 

3 3 
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[0166] [»52] 

P Xl (l) = Px 2 (0) 

Pyi(i) = Py 2 (0) 

P Zl (l) = Pz 2 (0) 

cos[ a 2 (0)] = 1 

cos[ A(l)-yMO)] = 1 

cc\ (1)^' 2 (0) = « , 2 (0)^' 1 (1) 

*r,(l) = xr 2 (0) 
1W 2V ' (4-14) 

Px 2 (l)= Px 3 (0) 

Py 2 (D = Py 3 (0) 

Pz 2 (l) = Pz 3 (0) 
cos[ a 2 (1) — &3 ] = 1 
cos[ /? 2 (1)-/? 3 ] = 1 

[0167] c^-e**ntfei 21hicoim:i 2iitf):£My3io(Drm£#to£z<t^ 

[0168] t-tz, -^M\znm<D&m&ffimTt&t£&mx-&t£i>. m^itt^ 
[0169] mx.i£r\-mo&m<$>&t&. nmoz&awik Nmnmm&ft m.v?Lit 

n-1 

©^PV'TK/^^-^aO, a1 , a2 , bO , b1 , b2 , h (Dl^tfMTL&o — 

n nnnnnnn 

n-1 

n-1 

[0170] n = 3tli«, ||^iC<!:tl312fli-efe^^<!:7!)^^orl^'S7!»^^). n 
5k*Dg&l*7 (n-2) + 5fi. ^^IC^LTJ^yiLOjCt 7 (n-2) 

fctLTiz. m%\mtmi*j&<Dffl\az (4-i5> (4-i6) jRommtff&viL'ozL 
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[0171] [»53] 

A F = [J ]A u (4-15) 
Au = [j]" 1 AF (4-16) 

[0172] ia±«fcy. n®<D&miz>$LT=bm&\zW£\m%.o>&&My. fritfmmt 

& <fc a &3#tc^ □ v -< KffiH jWt*. £ d <b #fc>fr & o 
[0173] (C)*J«!ffia)ft3£ 

<D*!J»Haa>-5 ;£<Z>-0iJ ic o in r it'* <5 o 

[0174] «ra-ei*. &?&m^&mtom<D®mm&&f£-?z>!&mtftbZtf. *p 

•RVltU h>(D3Q Discrete Clothoid Spl \nes<D§rftMQ<Dm$$M-<:fo&ffimiti 
U /^Lfc„ 3D Discrete Clothoid Splinesli. m^mm^^M. y 

r=4(D3D Discrete Clothoid Spl inesOD/K'J =f>Q£fE y . -^C^^S+^-e^ 

[0175] CC753D Discrete Clothoid Spl ineslcoi^TMSl&BJ^ <?>o Ell 4lz^ 
^tL^cfc^lz^t 5 . *IIB»*©jiS[5«J*lljiSlfr*M»P*fty. PO>#TI£ 

T^^ii^-t?r(n-1)+11i(DlI^^*#OC<blZ3£j:^o \>m^^^ U:?h£#i 
£fr<o0>iIL#-S§-<!: LT. #TIj^^qi-ea-T^<!:lcf #TI£lzfc 

[0176] ^(Di:^. T^<DT&&\B[±bmmittt%&?ttW-W)*mt^ > mm 
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(4-18) <7>Pifc£»/Mb-r <&£#<&) 7K'J=f>Q£ 3D Discrete Clothoid 
Spl i nes <!r H ^ o 
[0177] [ft54] 



(4-17) 



r-1 



X A 2 k ir+1 f, i={0...n-l}, A 2 ki =k i _ 1 -2k i +k i+1 
i=l 

(4-18) 



[0178] 3D Discrete Clothoid Spl ines-t?li#Hj£a>:7 U*»»3^^""C(=3ft*or 

0 0 

c o>jgg^ft ^ h;uti*7K ij =r>Q^^56fc <!: £ic^--ei::B!3E*a <t o r y 

. C(Z)t<!:3^7c^P V-T Kffi«(D&«W>:*£lz<fcy* 7K'J=T>Q(DTI^(7)1tll 

0 0 

[0179] [»55] 



u = i 



cos p cos or 
sin /? cos a 
- sin a: 



(4-19) 



[0180] 3D Discrete Clothoid Splinesli. TIj&7b^PS6$£lcafeA,-ei^<5 z 

4i+1 

4(i+1)-1 

iC (4-20) y 
[0181] [»56] 
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a0 4i + — al 4i + 



a0 4i + — al 4i + 



V4y 
3 

v4y 



a2 4i - a0 4iHhi 



a2 4i - a0 4 ( }+1) _! 



(4-20) 



[0182] Z(Dai***nftjb<a1 £a2 (D 2&7c5iifc*e3Sl::fcoT ft U . C*L*#l* 

4i 4i 

-C/^*-*a, a(D*JSBfltfr*o H«tlz/<7*-*b , b a>fcjg||tt,ft£ 

12 12 

[0183] «S**n»r*ffl*fih-C&*36<. C<D*D81iSo^T(*3&7c*QV-f KAMI 
[0184] [»57] 



a: 



V«' 2 + yg' 2 COS 2 g 

h 



(4-21) 



[0185] C©a«»-r*£:a(4r-22)lZJ&:y. h<D*D»lttj!fi*J£**i*o 
[»58] 

, _ V(al 4 i +2a2 4i ) 2 +(bl 4i +2b2 4i ) 2 cos 2 (a0 4i +al 4i +a2 4i ) 

n 4i 

^40+1) 

(4-22) 



[0186] £l±(D*£-C?7oa>3&7c*nv-< K/^* — * lzoi*T*J»Hl*ft5&*-<6 
[0187] (d)Mr^J 

ftB(=Ki±(=ai'<fc¥aj-ejiSi5«J**inufc«iLr(o.o 1 o.o, o.o), 
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(2.0, 2.0, 2.0), (4.0, 0.0, 1.0), (5.0, 0.0, 2. 0) 3 &7t<7 n V 

[0188] 2 |z«.ffi|ft<Z>/<=>.?t—$e£ % £^3,^ ■ & 

[0189] [*2] 

a= -0.657549 - 1. 05303S + 1. 84584S 2 
j3= 1.03297 + 1.29172S - 2. 55118S 2 

h = 3. 82679 

P 0 = (0. 0, 0. 0, 0. 0) 

os= 0. 135559 + 2. 18537S - 2. 69871S 2 
j3 = -0. 226655 - 3. 15603S + 3. 03298S 2 

h = 3. 16932 

P 0 = (2. 0, 2. 0, 2. 0) 

a = -0. 377569 - 1.45922S + 0. 984945S 2 
0 = -0.349942 + 1. 32198S - 0. 873267S 2 

h = 1.43987 

P 0 = (4. 0, 0. 0, 1. 0) 



[0190] [£3] 
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Coord: ( 1.16 x 10" 5 , 2.00 x 10" 6 , 3.82 x 10" 6 ) 
Tvector: ( 7.59 x 10" 5 , 1.50 x 10" 5 , 2.95 x 10" 4 ) 
Nvector: ( 2.93 x 10" 4 , 9.19 x 10" 5 , -7.57 x 10" 6 ) 
Curvature : 3 . 06 x 1 0" 7 

an 2 1 an 3 <Dmm& 

Coord: (-4.33xl0~ 6 , -1.64 xlO" 6 , 1.11 xlO" 5 ) 
Tvector: ( 2.06 x 10" 6 , 2.33 x 10" 4 , 1.97 x 10" 4 ) 
Nvector: ( 3.30 x 10~ 4 , 1.19 x 10" 5 , -3.23 x 10" 3 ) 
Curvature: 5.96xl0" 6 



[0191] (2-4) ffim~&lf&&moUtott&LtzG 2 mmtji3&7z9u v-f KM 

n 

[0192] (a)W3§kfttm$a$l 

<&3#tu?p V-T K«»fcot^-C*ft1«U*a , a, a, b, b, b, h£>7o&£ 

0 12 0 12 

n-2fifc£&|*j{&^£:lcjEaL ffi«>7fi«3o£*&jiSilzfclt&g 
*(D3fij&<#£-*-£ ^Sp-C7(n-2)+3fi-C*-6 0 2-30>^-ettC*L(zJ& 

[0193] CCt, ■ »jSif=telt«ft« ■ >£gl ■ fi]ip£»PU ^oG 2 ^<b^^> 

o *tt3Sl*£an?7n-3fi£l*?££l=£S, **D8(Z>8 
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[0194] fct, zc-ei*. ffir£\s$&&&mzizMA-?z>^t\z&'oxm%\mtm 

Hit. $fttzt£&& 2 Oj^A L> #£<£JS«(7)5^2 0£;fe*nife<h: LTtfcdo 
[0195] ^<D»^ffitt^i3&<2O«S?LS<0-e. ^S^jSlco^t^^It, &ISL 

fern. i$®7io*o0i 4flii§*.£„ -^-c. **q^i*3^7u^p y-r k 

^^2 0i^.^fl)T\ a, a, a, b, b, b, h(D7o-3otf>^t+ 1 4l@(Z>=fc 

0 12 0 12 

% ^re#*££5Mn»l*7(n+1)fl. ^iCUmn+1)+41i<tl^c£|c&£ 

> mm&omm • mm • mm^pmLtzW^n^^t^m^ta^o 

y ny^ K*!l#lcoi^T**alfcl*a , a, a, b.b, b, ha)70fc^©t, * 

0 12 0 12 

mm&?t\zmm. mm. mm. ^m<om^tm^\z^if^mm<D3m^ 

S5^fc^-C$«J^i^*L^^#^S{*4oj^±t^^Ci:lc^^ 0 JilT. mW<P 
Xmlt4M±0>&f£m. Mt2VL±£mmxfoZ>t LX. mtzlz&ZmALtzt 

[0197] (i) m=2k(7)<i:# 

WttT?*fr1*Tm=2kfi©ES£1H1*p*S£#. **n»l*£i*-e7(n-1)fi. 
tt^fr-C 7 (n-1 ) -4+2kli "C ; £ „ C 0) £ £ iS*J ftftfr l*2k-41@ X&& 
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foVl (n+k-3) -4+2km <h ::i!Jb lz*rfclz#A Ltz&&<DmM<Dm<D 

?*>2o (fflittfx.y) £**aife<t LTtsa<!:f ifc%\mt±i*X 

7 (n+k-3) +2 (k-2) mft&lt±i*V7 (n+k-3) +2 (k-2) M t tt V **Qifr <t: gzft 

&<Dm<mL 

[0198] (ii) m=2k+1 <Dt£ 

. ^#^(*^-e7(n-1)+2k-3fli-efc^o C(7)i:^igfiJ^^^J*2k-3fls|-efe 
£o k-1flS<D^^gffelcSAf <§>c<!: 3^PV^fKM 
*><k-1*. &^j£^k-1l@ii*_£<7>-e. 5fcftifel+.£ft-C7 (n+k-2) fll. mft&iz 
±&X1 (n+k-2) -3+2kfl3 <b CZt^b Ic$t/cIz^A Lfc#j£<DJS*I(Dfii 

£>?*>2o ($J*_[;£x,y) tttoWit LTtfc? <bf & t, *%\mt±fcX 
7 (n+k-2) +2 (k-2) *#5tl*£f*T*7 (n+k-2) +2k-3M t & U 3M«(DII&#1 o 
^<^^ 0 m=2k+1a)it^•|c[^ALfc^a)a*)t^<i:-^(D^lcfct^-c 
l*J^0>1ta>d^1of£l+£*ftg&<!: LTfe^irf -So ^"T^Cfe, 
IJ[(*^^-e7 (n+k-2) +2 (k-2) #1 . ^^^(^^^^7 (n+k-2) +2 (k-2) 1i <b y * 

[0199] Jil±lz^fc^5i(7)<i:ai3. jiiP^^^^tD^lc^-t+T. i?AL7c£ 
[0200] [«4] 
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4 


0 


0 


0 


0 


5 


1 


1 


l 


1 


6 


2 


1 


2 


2 


7 


3 


2 


: 2 

HB©/K : 1 


3 




2k 


2k-4 


k-2 


k-2M<Dj& : 2 


2k-4 


2k+l 


2k-3 


k-1 


k-2{@CO^; : 2 
: 1 


2k-3 



*k : 2U±(D&m$t 



[0201] (b)#>£ 

Step3)Step1©ffi«/<7*-*£*J»Hit±: It, Btt<D*tt£j»fc-*-<fc 5 £ 
[0202] JsTF. *&S tep|CO^-Cl&IE£*iS?-£o £TStep1 |cfct^-CI*. Ifcfft^lR] 

Ltlis 2-3<D#^i:|^i:*JJttflS*fflL^o 
[0203] &lzStep2lzfclNT«fcfcji&£#AU ft#t*»»a>*a>BI»*fT5 £ t 
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[0204] S&C:Step3lzoi^-C-efc<?>7!>^ Step3T?fT? —o.— h > ■ =p Z? V ^feOtz 

l^ffitftlcOLXTI** Step1-e^fiRLf=ft«(DflS*-t<Z>**fflt^o ISLfC, 
Step3lcm*ffi&(D#/^*-*<D^#ffi£^Lf=o c<D*J»Hj&£m*T 
. -zl— h> ■ ^;/y>&lc<fcoT*#£;Kf=/^*-**N£3&7Gy P K 
ffi«££j*U ji!5"JIH*BWa>ftfr*atfc , r«fe5<!:32fc5c^Py-r Kffi«"C« 

[0205] (Ottfflftl 

SUKfcffiSg-ecD&ISL &ftgL ft¥^5©^#-e$iJ^lL^-^cfc9(c3^7c^ 

py-r K«iwLfc«*is-r. ii*rz3i*^*Mn»*©jft(zaiLii#*«y 

. P , P , P t Ltz 0 

1 2 3 

[0206] [£5] 













Pi 


(0, 0, 0) 


(Cos(0),Sin(0),O ) 


(-Sin(0),Cos(0), 0 ) 


0. 2 


p 2 


(4, -4, -4) 








Ps 


(8, -4, -5) 


(1,0,0) 


(0,-1,0) 


0. 2 



* 0 = - — t-rs 



[0207] Cfl>^#-e, *IKlcMlffl*fTof=IS»*H1 9lc^f 0 £fft<Dffifft*<3& 

tu<7 p y-r rats* ttie ■ ■ ■ =&mmiz&&m<D&m* 
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[0208] imi 





em 






mm 


Pi 




{0.0, 0.0, 0.0} 


{0. 8660, -0. 5, 0. 0} 


{0. 5, 0. 8660, 0. 0} 


0. 20 




{0.0, 0.0, 0.0} 


{0. 8660, -0. 5, 0. 0} 


{0.5000, 0.8660, 0.0} 


0. 20 




{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 


p 3 




{8.0, -4.0, -5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 20 




{8.0, -4.0, -5.0} 


{1. 0, 0.0 ,0.0} 


{0.0, -1.0, 0.0} 


0. 20 




{0.0, 0.0, 0.0} 


{0. 0, 0. 0, 0. 0} 


{0.0, 0.0, 0.0} 


0 



[0209] (d) tpffl&T'&moUW 

[0210] ft*.(2H2 1 (D&vft&m&ttffi-rzwi'S^te^T, *m&p xmm. mm 

c 

t\z& or tpn\&T*(Dm&%mLtz 0 
[0211] &m\zK Lx-m^mr£\&nz><Dx*itti:<, tpm&p &&/ux& 

c 

1 2 c 

(b) <Z>¥5£ £ ffl £ c <!: £ 6 <fc ? £ 0 
[0212] C(Dcfcai^J^PLfcLMit(Dfe^^-t:^^^lt. ^0)i^aMlzfclt£fif 

&& • ■ ffl*0)ftiJ»Rrtll3B:3^7c^ □ V-T K«H*fT5c:^A<1?**o 

[0213] (2-5) mm&xcDmm, mm. mm&%m Ltz3 ^7to □ v-r kmn 

[0214] (a) jffift 
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[021 5] (b-1 ) W£\n&<D& & „ 

^<Dm-em#.7?£m<D3&{o.o, o.o, o.oms.o, 5.0, io.omio.o. 

10.0, 5.0}£#*.fc o *©ffe#jitU3-5a.fc£!SL &ftg* ffi«s:£f<D&tt£* 
[0216] [*7] 





MS 








Pi 


(0. 0, 0. 0, 0. 0) 


{0.0, l.o, 0.0} 


{1.0, 0.0, 0.0} 


0. 1 


P 2 


(5. 0, 5. 0, 10. 0) 








P3 


(10.0, 10.0, 5.0) 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 1 



[0217] (b-2) r=4(£>3DDCS£>£jfJc 

3£-e&£3D Discrete Clothoid Splinesf*. m&\~W£lttflL&$:m [ >) , ffl^ 
r=4<7)3D Discrete Clothoid Spl inestD/K'J =T>Q£fF y % fc^bttlt^ 

^Ltco &tz. ni«izza)jSi5ijcfey^**Lfc7Ky^>*ia2 4iz. hj£<d 

[0218] [£8] 
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Pl 


{0.0, 0.0, 0.0} 




{0. 4677, 0. 4677, 3. 1228} 




{0.9354, 0.9354, 6.2456} 




{2. 3029, 2. 3029, 9. 4966} 


p 2 


{5. 0, 5. 0, 10. 0} 




{6. 7095, 6. 7095, 9. 9244} 




{8. 0655, 8. 0655, 8. 4732} 




{9.0327, 9.0327, 6.7366} 


p 3 


{10. 0, 10. 0, 5. 0} 



[0219] (b-3) tommotkM 

%HDj5:MM$:3tisbX%kfe-?& 0 3D Discrete Clothoid Spl ines-ete&Hj&O) 

0 0 

7K'J=r>Q^*i6fc<b^lc-r-eicl!S*n<!:7£j:orfcy. C0)t<h3^7u^P V-< K 
fl^^^sC^lc.fcy, 7K'J=f>Q(DlI^(D^^lS]|ll^af, 

0 0 

[0220] [ft59] 



u = < 



cos /? cos a 
sin /? cos a 
- sin a 
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[0221] c:t% 3D Discrete Clothoid Splines!*. m&rf^$BM\^$LAjT:^& Z 

4i+1 

4(i+1)-1 

[0222] [»60] 



a0 4i + -J-al 4i + 



a0 4i +-al 4i + 



1 



v4y 
UJ 



a2 4i - a0 4i+1 



a2 4i - a0 4(i+1) _! 



4i 4i 

12 12 

[0223] «***nttr*ft«fih-(?*^36<. ^CDlD«fiil30^rii3^7c^P v-r Kffl 
l¥(DiCcfcy^tlif 3^7C^PV-T Kffltft<Dffi^(&* TSB-C^^^^ 



[»61] 



K = 



_ <Ja a +0 a cos 2 a 
h 



[0224] C(D^^^-r^<bmT(DiClz/j:y x h<D*D»tt*<*3£**L*< 
[tSt62] 



4i + 2a2 4i ) 2 + (bl 4i + 2b2 4i ) 2 cos 2 (a0 4i + al 4i + a2 4i ) 
h 4i 

^(i+l) 



[0225] Jil±<7>^54-e7oa)3^7c^ □ V-f icoivcajSBfiS^SOr*-* 
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[0226] HURlzc©^(zJ:y3ft*t = *j»Jtt$*9lz|a-ro 
[*9] 



^PiiP 2 i: 


a 0 


0.0 (g££p) 


a x 


-0. 2684 


a 2 


1. 0739 




re/2 (gEfci) 


Al 


0. 0 




0. 0 




12. 7684 




a 0 


-0. 1648 




3. 2061 


3 2 


-2. 6327 


bo 


0. 7853 


bi 


0.0 


b 2 


0. 0 


h 


9. 6752 



[0227] (b-4) .*«lz#jft£ay, G 2 B^3^7C^PV>r K«H 

(b-3) r&3£ Lfr*flJim£m^TG 2 iiM<t &&<fc ? &^Tr#flgU£>/^ 

[0228] ::t% 3jSa>33fc7c*nv>r K»IBHzfci*T\ «fclcffiH*«fea>ji5i£iiy 

, p, p©3^7c^pv>r Kara^-r, jsp, PiH£ie&ftfft£fflfftc* j£p, 

2 3 12 12 

PIH*«S^i**i«Ci:t*i:, aOi:bOI*K(cKfli-e**^&. **nifcl£ 

3 2 11 

> mm (D/^^-^al , a2, b1 , b2 , h „ ffigiC (D/i? * -£a0 , a1 , 

1 111112 2 2 

a2, bO, b1 , b2, h (DUMt^^o VL&t$im\ZT*X < &$i¥<D-y-?X5 'J 7 

2 2 2 2 2 

li^a. mm^mn^mommtLxPx, p y , p z , <* ,0 , n 

i i i i i 
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i i 

[0229] tf, m>\^te^x\*mm^m$tt$sL<D&&m.&t^?§km$.z&^u y 

[0230] ;*lc£P|co^-C#*£o &Pltm®m±<DmffitiV&V. G 2 51*|zfc£|z 

2 2 

2 

[0231] [»63] 

Px,(l) = Px 2 (0) 
Pyi(l) = Py 2 (0) 
Pz,(l) = Pz 2 (0) 

COS[ — ^2(^)] ~ 1 

COS[ AO) -^2(0)] =1 

n 1 (l).n 2 (0) = l 
*i(l) = * 2 (0) 

[0232] «^lc^P|coLNT#^^>o j£Pl*»ji*T?*y. ffitz-r^mmtiiLW:. tit 

3 3 

3 3 

[0233] [ft64] 

Px 2 (l) = Px 3 

Py 2 (i)-Py 3 

Pz 2 (l) = Pz 3 

cos[ a 2 (1) — ctr 3 ] = 1 

cos[ A(1)"A] = 1 

[0234] J^Lt^ y . 5fc£]&a1 , a2 , b1 , b2 , h , aO , a1 , a2 , bO , b1 , b2 , h 

1 1 1 11 2222222 
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[0235] [#65] 

Px 1 (l) = Px 2 (0) 

Pyi(i) = Py 2 (0) 

P Zl (l) = Pz 2 (0) 
cos[a 1 (l)-a 2 (0)] = l 
cos[A(l)-/? 2 (0)] = l 
ni -n 2 = 1 
ac 1 (l) = ic 2 (0) 
Px 2 (l) = Px 3 

py 2 (i) = py 3 

Pz 2 (l) = Pz 3 

cos[ a 2 (1) — a 3 ] — 1 

cos[^ 2 (l)-^ 3 ] = l 

[0236] Z*LT?*tt»12filzo^rl2fi(DS^ySto©^#**«)-5zi:A<-e# 
-So c<Dj££-zl- h> ■ 7^V>;iiaotg#, fif£##>/ro 0 1 Olz 

[0237] [*10] 
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-Vn -y-rr /— fc- 


At? 

m 




a o 


0. 0 (JPBen) 






-0. 2684 


-5. 4455 


■32 


1. 0739 


5. 4122 




tc/2 (gEftl) 




^1 


0. 0 


-3. 8590 




0. 0 


3. 1003 


h 


12. 7684 


13. 5862 


&P 2 kP 3 k & 


a Q 


-0. 1648 


-0. 033258 




3. 2061 


3.6770 




-2. 6327 


-3. 6437 


bo 


0. 7853 


0. 8120 




0. 0 


1. 6006 


b 2 


0. 0 


-2. 4126 


h 


9. 6752 


9. 2873 



[0238] (b-5).Effiife|(Z>£j£ 

HI 2 6 (£ (b-4) X*3&tbtz/^ * ^Ttlz^m Lfcffi«£b-2-e£j* Lfc/K 

2 

[0239] (b-6).^ie<b7k*Di& 

1 3 

o fct, **Diiti:^Te^^^lJ:^fc«)lc. EI2 Tlz^^^x^cfc^lz 
fl^C(Dfi^S^ii[S=0.5(D&Blc^DP^iff7ilz^AL7io &tz. ffli&C <£>o 

1 1 2 

^T^ft^*^S=0. 50>{iffilz£DP ^ifTilz^ALTio 

2 

[0240] ^<Dt&, &p t&DP &%i&mm&mm' . ^DPt^p^^a^^ft^ 

11 112 

c* > ^p t&DP&m&m&&mm' . £dp t&p &m&&m&mm' t 

2 2 2 3 2 3 4 
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(DmWit LTPx , Py , Pz , a , 0 , n , k GDcfc 5 Ci^fo ■ $t£ 

c c c c c c c 

mfci^-ci*. mm. fe&mufta, mm^^vitPx , py, pz, 

s s s 

a , 0 , n , ac . *!j&-ef£Px , Py , Pz , a , 0 , n , k Ok 5 Ic^f o 

ssss eeeeeee 

[0241] JiLTlc^^|zfctNrj|£y3i:o^^I3-ro 
[£&66] 

^ Pi : mm, mm, mm -.4m 

cos[a c ,,(0)-aj = l 
cos[^ c , 1 (0)-^J = l 
n c ,(0)-n, =1 

m dp x : siik mm, mm ■. i m 

Px c . 1 (l) = Px c , 2 (0) 

Pyci(i)-Pyc- 2 (o) 

Pz cll (l) = Pz c , 2 (0) 
costorc-jCO-ac^CO)] = 1 
cos[/? cll (l)-/? c . 2 (0)] = l 
n C 'i (l)-n c . 2 (0) = 1 
*"c'i (l) = ^c'2(0) 

Px c , 2 (l) = Px c , 3 (0) 
Py c . 2 (l) = Py cl3 (0) 
Pz c , 2 (l) = Pz c , 3 (0) 
cos[a cl2 (l)-a CI3 (0)] = 1 
cos[/? c , 2 (l)-/? c , 3 (0)] = l 

n C '2( 1 )- n c'3(°) = 1 

AT C . 2 (1) = K- C '3(°) 
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£ DP 2 : QlU, ifeifc, ft* : 7 m 

Px c , 3 (l) = Px c , 4 (0) 
Py c , 3 (l) = Py c , 4 (0) 
Pz c , 3 (l) = Pz c , 4 (0) 
cos[a c . 3 (l)-a c . 4 (0)] = l 
oos[p C3 (l)-p c . 4 (0)] = l 
n c -3 (l)-n C '4( 0 ) = 1 

K C , 3 (1) = K C . 4 (0) 

^p 3 : mm. mm. ft* -.im 

Px c , 4 (l) = Px e 

Pyc'4(i) = Py e 

Pz c , 4 (l) = Pz e 
cos[a c . 4 (l)-a e ] = 1 
cos[P c . 4 (l)-(3 e ] = l 

n C '4(l)- n e =1 
K G - 4 (l) = K e 

[0242] ia±«fcy* tft^yaoK^aiis 2i@-efc^ 0 ::t\ #a&*< 

Jlo^py^K/^^-^tta, a, a, b, b, b, h0)7O-5otifey, ^ 

0 12 0 12 

1.^20©^, DP 2 <Dy.zJS«**ftl»tL-C«lV *£ni&£4oii^ Lfc c d 
[0243] (b-7). tOWflSa)*^ 

Tl*. m 2 8 (Dcfc r> lz (b-5) Lfc 3 &7t0 PV^f Kffi|g£$r L < #A L 

[0244] ffl^^fij>±ico^-ci*. fi^c^ft^c t&m' t\zftm?z>ij>£&m 

1 1 2 
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W-?Z>k^ mmc ©^PV'f K/^*-*h\ a' , a' , a' , b' , b' , b' 

1 0 12 0 12 

1 d 

[0245] [»67] 





= a 0 


aj 


= a i s d 


a' 2 


= a 2 S d 2 


<b' 0 


= b 0 


b'i 


= biS d 


b' 2 


-b 2 S d 2 


h' 


= hS d 



[0246] &ic#hjj5dp &m&L?zmm' ico^r^^^o AtftC 

1 2 1 

K/^y-^h", a", a", a" , b" , b" , b" li. ffi^C^fiSiltf)/* 

0 12 0 12 1 

[0247] mm 

'p; - pa) 

a'o = a 0 + a 2 + a 2 + 
aj = -(aj +2a 2 ) 
< a 2 — a 2 
b& =b 0 +bj +b 2 
b 1 » = -(b,+2b 2 ) 
b 2 = b 2 
h" = h 

[0248] C(7)ffi^±lzfc^r^«iJ^DP(i. DP=C" (1-S)ti$W, CCtM 

1 1 1 d 

1 1 2 
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2 2 

i** 0 tt^c ^±mLtz^m\^^^mm" it. ^mi-^^t^x^^ 0 c 

1 2 
2 

tilt. ffigJC It^-t hZ.t b<X £ & „ 

2 

[0249] J^±(D^}±-e. 3;*tu^ P V-T KffllRC±©ffl«fi*»^S=0. 5-C fe-Sj^DP 

112 2 

<Dffi««*tt3&<S=0.5-C*-6MiDP-Cffl«C*ffi«C' <tC £ izftmrZ c ttf 

2 2 3 4 

x£& 0 

[0250] C(D^}±-e^fiJLfc40(Dft^(7)/^7>-^^*1 1 iclNrfco C<Dffi*£a> 
[0251] [£11] 





-30 


0.0 (fE^P) 




a 0 


4.9134 




Si 


-2. 7227 




a x 


-0.016629 




•32 


1. 3530 




a z 


1. 3530 




£o 


7t/2 (gfcfcO 


ft& 


bo 


0.41633 


C i 




-1.9295 


C 2 


b x 


~0. 37938 




^2 


0. 7750 




b 2 


0. 77507 






6. 7931 




h 


6. 7931 






{0.0, 0.0, 0.0} 






{1.8431, 3.0860, 4.9597} 






-0. 033258 




3.Q 


7. 1774 




S X 


1. 8385 




a x 


0. 016629 




a 2 


-0. 91093 




a 2 


-0. 91093 


ftH 


bo 


0. 81202 


ft 11 


bo 


1. 0091 


C 3 


b l 


0. 80031 


C 4 


bi 


-0. 40601 




bz 


-0. 60316 




b 2 


-0. 60316 




h 


4. 6436 




h 


4. 6436 






{5. 0, 5. 0, 10. 0} 






{7. 0029, 8. 1298, 7. 5337} 



WO 2005/083537 



61 



PCT/JP2005/002132 



[0252] (b-8) .§ki*&ffitz?<7U y*f K/^*-*£5fc#>£ 

(b-7) XZkfe Ltc%)Mm.&7z\^ (b-6) XiLXtzm*ttmtz^m*-=L- 

k>- ?z?v>mx>&sbtz 0 mi 2itMta£*itz&m$%(D/^*-$x&& 
„ *fc, $1 3i*-^K.t=tti:^**Lt=ftiia)*&jiSi-»jaa)ftii. ft 

[0253] [£12] 



§ tlft Aitft ^ ^ — ^ 



C ! 


S 0 


0. 0 (JEE&O 


mm 
c 2 


3 0 


5. 3846 




0. 0000 




-3. 4602 


^2 


-0. 89854 


a 2 


4. 341 


^0 


tc/2 (5£*P) 


bo 


0. 47690 


^1 


-0. 51836 


bi 


-3. 2143 


^2 


-0. 57552 


b z 


3. 4613 


h 


5. 1836 


h 


9. 9808 




{0.0, 0.0, 0.0} 




{1. 8431, 4. 1726, 1. 4653} 


C 3 


a 0 


-0. 017740 


mm 

C 4 


a 0 


6. 8553 


ai 


3. 4572 


a 1 


-1. 1443 


a 2 


-2. 8673 


a 2 


0. 57219 




0. 72385 


b 0 


0. 76315 


*i 


2. 4551 


bx 


-1. 1942 


^2 


-2. 4158 


b 2 


0. 43108 


h 


6. 60818 


h 


3. 3206 




{5.0, 5.0, 10.0} 




{7. 0029, 9. 0734, 5. 6186} 



[0254] [£13] 



WO 2005/083537 62 PCT/JP2005/002132 





Mi 








Pi 




{0. 0, 0. 0, 0. 0} 


{0. 0, 1. 0, 0. 0} 


{1.0, 0.0, 0.0} 


0. 10 




{0.0, 0.0, 0.0} 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0. 10 




{0. 0, 0. 0, 0. 0} 


{0. 0, 0. 0, 0. 0} 


{0.0, 0.0, 0.0} 


0 


p 3 




{10.0, 10.0, 5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 10 




{10.0, 10.0, 5.0} 


{1.0, 0.0, 0.0} 


{0. 0, -1. 0, 0. 0} 


0. 10 




{0.0, 0.0, 0.0} 


{0. 0, 0. 0, 0. 0} 


{0. 0, 0. 0, 0. 0} 


0 



[0255] (b-9) . figJ(Z>£j& 

(b-8) vj£dbtz/^ * iz£ y $ij&£titz8&m$m 2 9 \ZTjk? 0 mm*3 
%.7t<7 □ v-r mm, mm • -&mm ■ -j^mrn • =&mmi*&&m<DJjfa 

[0256] &±t:\ mrnvmrn. mm. &nm^mm Ltz3^7t<7 ay ^ K«ra&ic«fc<& 

[0257] 3 . 3 &tc>? □ V-T KMr H 1^fflt^/c7t<-/U3b C(D[H]'Jft^(D|SS+^i 

^a>/K-/ute i:cDiHi!iftigiE&a)iSa+^fT 3 . 

[0258] (3-1) ^^U^^-^^^tK-^CcD^ 
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to 

[0259] J^TIct'^U^^^^ ht-i*(D$<<Zf<D7£-)\,teC{Z'Dl\xmWi-Z> 
o HI 3 21*. f^U^^^tf bt—' fo(D$<<?<D7n— )\,teC<Di~v h 1 £ 

©#-/l«£»l=-**1*fcy- K****. HUIM£R£ L.r<D/|?-;ufltai 

'j- K**-r* 0 c+L^m^#-/u$K^2&t;7f?-/utiBR»3-e— d(d- 

£4*jtHI£^U 0 3 3 Bl*^7tC-/U$E^;f 2tfM.Z-Z>#im<D-)-V h 1 tf>5& 

[0260] ^<Di-y h 1 ^fec$*ic$i^^i±yc^^^-ra)^iii3 4-efc& 0 

tK-ZUHB!^ 3 t to. cm 5 ©7K-/HE3t* 6 t (DMI=I** Utf y 3MBj nT^fc 
;t 2 <t £$6 5 (D7K-/u$E^;i 6 £ (DF H irm^£gl+&*>^$E^ y MWit & 

o 

[0262] HI 3 2lZ^H^>±^ h 1 (DtH— ;U#^;«3t!»<EI3 1 IZtf^&t^ 

[0263] t£*<D^^;U(D<S»e»r*H3 5<0SiaH$fei:«ifz##oitfc^#|z. 
$IS&£te DUU £ ^-/Utf^ofr £> icfc C$ft tfikfr P>8t-f z irTH^ibtL 
Tl^#. C(D^S&l*Hl3 6(DfiW^b^MT^-g>®y. ft^aSUfC* 
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[0264] M3 7 lt7[i-)l,tpfo<D®.^$:7iki- 0 TK-ZKOfltBRftKA^i*:^ LTG 2 3£«t 

[0265] (3-2) JiLTIC. 3^tu^P V^f Kfi^^ffl^r^^U^^-^^^TK 

[0266] (a-1). teC$tot7fs-)[, 

[0267] [*14] 





28. 0 


df— /V^O^g (mm) 


28. 0 


«S (mm) 


24. 825 




5. 6 


sj?— /Pg(mm) 


3. 175 ; 



[0268] (a -2). Kfo&tmm%k 

7? is<7$-$-< z?<D7$-)\,te £<DiE\mmmz. ^ommmm^^n 
■cft*j^5iA<**o * ^x^mixm^tzmmmz-Di^xmrn-? &<> 
[0269] *-r. H3 8 <*: 3 fczift^fe Diai^iRircax^o H3 8<o^ns»*fei:siic-to 

T7H-/u^ili^Lfc<!:^lC7K-/U(D^'^S<l>l3l-efc^o Hl!HN£S& 

s e s e 

££j£P <h Lfco J&P k&P ltm3 9<D£?\zxy¥-W^<Dmmx>M.&t, Jf 

m s e 

£0. olp k&?T*=mm=nf&&ft&ifi* ^<D-mm= nmozp op omm. 

s e s e 

m 
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[0270] nm\^miLtct£\^te=i5° tLx&&<Dmm&ikj£Ltz 0 -t*n=«fey 

[0271] [«15] 
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m 
m 

AJ 

G 





0. 071428 


0. 071428 


1 




O 








O 


O 






96592, 


. 96592, 


1 


m 


O 


o 






25881, 


. 2588L 






c> 


o 






063533} 


063533} 






o 


o 




m 
m 


{0. 96397, -0. 25829, 


{0.96397, 0.25829, 


| 1 




. 5563} 


. 5563} 






CXI 


Csl 

1 


o 




-13. 5249, 


-13. 5249, 


-13. 5249, 




{-3. 6088, 


{3. 6088, 


o 
o 




in 


CO 

Oh 


B 

Oh 
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[0272] (a-3). ffilfc^f* 

s s 

Efr < fl & t G 2 jiH T? h & Wrt fc o 
[0273] <fclz N 7K-/U£^lf£A£lcoivC#x.S±:. 0'J§^S§^y$ftM^-efc^ d 

h 

§ (13 8,3 9#I) o Z(Dt£. 7$—)l,tfteC\h$:mTfm?LZ><D\aZ^ & 
P <DyJSai<Dlfe*HiSA<^^ < £ t 

h 

<jfcp a>yj£*a>ifi»tt) ^ (toi:$im?i+7t-;-/i^) /2 

h 

(jSP ©y*»©fft*Hit) = (tei:«iHS+7K-/uSxi.2) /2 

h 

to, 1 , o} v*>&&m<te y > ft«*iRU*-€-a>iii y ^mii-r £ ^ £j£ Lfr*#/cfc 

[0274] &±<&3M*£*f= U y»l#*fclHl»«K£3&5G* □ Kffifft-e£jiR-f 
[0275] (a-4). 

t fcy^^^-pfe(D-c:^^^Bcy•^t■<^^-pr^^^„ nuiMMtiu fee 
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[0276] ::t\ fr*!fe$&®mm&\^A^t^*g(D&m l^^T&^&o 

S 1 

LTPx, (S) Py , (S) Pz (S), a (S), £ (S), n (S), tt (S)<Dcfedf=. £fc. 

1111111 

^p • ^p icfciNrii. j&hl ^m$E^Qf. 0, mm. mmz&p vitPx , 

s h s s 

Py , Pz , a , 0 , n , k . j&P VltPx , Py , Pz , a , P , n , h (DJ: 5 lc 

ssssss n hhnnnhd 

> j&p izfciNTTie^yjiocfefe^o 

s 

[0277] [»69] 

SP 8 : Sfelt, ft* :4m 

cos[ai(0) - a s ] = 1 
cos[A(0)-/? 8 ] = l 
n 1 (0)-n s =l 

JKi(0) = JC B 

[0278] ^C^^»-r<g>7^-;U(D^ii>(7)©l^fS<ft^(*. 3#7E?PV>f 

0 

pit. te£$$iftM&Rs feD^e^^H^of £ Ltz 0 

0 

[0279] [»70] 

<z 0 (S) = -a 0 

h 0 = -y/pit 2 + (2^R ) 2 
P 0 (S) = P e + h 0 £u(S)dS 

[0280] ffi^C <7>^TI*£P I*. P =P (11/12) tm^Zo <3\ £P ^ U £P "Cffl 

0 s s 0 s s 

0 1 
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[0281] mm 



«i(S) = 


/- 


A(S) = 




Pi(S) = 





7T 



+ 



60 



bl 0 +^~b2 



S "TT M ° + T b2 ° |s» 



60 



[0282] mnit, z<D§kft&ffitz?mmc^t it, ai 6 0)/^y-^^ifo3^7c 

[0283] [*16] 





<3 o 


6. 2196 




5 1 


0. 0 






0. 0 




£o 


6. 0213 




^1 


0. 10472 






-0. 41887 




a 


1. 4631 






{-3.6088, -13.5249, 2.5563} 



[0284] ^<Dt&, ^Pfcfcit^ffl^c tmmcomm. mm. mmnm&itwiLx 

s 0 1 

[0285] [£17] 



WO 2005/083537 70 PCT/JP2005/002132 



© 
p 

CO 





0. 071428 


0. 071428 


o 


X 


.96592, 0.0} 


,96592, 0.0} 


000, 0.000} 


m 


o 


O 


o 


w 


25881, 


25881 


.000, 




o 


o 


© 




063533} 


063533} 


000} 




o 


O 


o 


*N 
X 
M 

m 


0. 25829, 


0. 25829, 


0. 000, 




{0. 96397, - 


{0. 96397, - 


{0. 000, 




2. 5563} 


2. 5563} 


000} 


m 


-13. 5249, 


-13. 5249, 


0.000, 0. 




6088, 


6088, 


{0. 000, 




CO 


CO 

1 






o 




m 
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[0286] ftfc. COflM4 1, 4 2&M.Tm&mym^teC^ZM-?£ : 5ti: 

s 

* S (Dffi^ ICO INT I* d <£>/ < 7 * - * <M$£ £J3 t^c o 
[0287] (a-5). 3^tz<7 P V>f KMnoft^^Mft 

s 

h 

0. j£|ft % ffi*£ffi«fi£»Sa>|j|8£ LTPx , (S) Py, (S) Pz (S), a (S), 

i i i i 

£ (S), n (S), k (SXD^^^m.'to j&Plzfc^TI*. t^Hl$E 

i i i h 

ft a > ,8 . fi^^Px , Py, Pz, or.yS, n, h ? Ic^-To 

h h h h h h h 

[0288] %&&<Dmit$^X > mmi^ii^^^j^fi^P <tj£Ptf>2j& C(D 

1 h 

w B i2^co3^7u^py^ Kara -c* -60 cc-e, B5S^-e<Dara*#*#^ 

1 h 2 

f£o *fc^p <t£p &m&mm*mm . j^p tj^p $ig^ffl«$a«ic <t-r 

1 2 2 2 e 3 

'So 

[0289] J*IT |z If $fflra&tt ^iBf o 

mm 
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m. Pi : mm, mm, -.4m 

cos[ a 2 (0) - ^(l)] = 1 

cos[ /? 2 (0)- AO)] = 1 
n 2 (0)- ni (l) = 1 
*r 2 (0) = ^(1) 

/£ P 2 : fit 11. ft^ : 7fi 

Px 3 (l) = Px 2 (0) 

Py 3 (i) = Py 2 (0) 

Pz 3 (l) = Pz 2 (0) 
cos[ ^ 3 (1) — or 2 (0)] = 1 
cos[ /? 3 (l)-/? 2 (0)] = 1 
n 3 (l).n 2 (0) = l 
*r 3 (l) = *: 2 (0) 



£ Ph : J3 „ mm : 5 1@ 

Px 3 (l)=Px h 

Py 3 (i) = Py h 

PZ 3 (1) = PZ h 

cos[ /MO] = 1 
n 3 (l) -{0,1,0} = 1 

[0290] j*i±<*:y. ^i*-e^yitoK**frscf*i6ffl7?ft^„ c^-e. 

*<#o?n V-T K/<7* — £f*0>a , a, a, b, b, b, h(D7 0tfe^ 

0 12 0 12 

f=2oa>jiS[P 2 a>y.zjsai$*fti»t l-c»lv **niS[^2oii^Lfco cti-e* 

h 
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[0291] (a-6). mS-Zmtttu y-f K/^*-*£5fc#>£ 
[0292] [*18] 



mm 


a 0 


-0. 063576 


a x 


0. 0000 


^2 


0. 62696 


^0 


-0. 57595 


b x 


-0. 98004 




0. 77916 


h 


1.9561 




{-2.2429, -14.021, 2.6492} 


[Slits 
c 3 




6. 8465 




1. 729 




-0. 86450 


bo 


-0. 77684 


bx 


0. 79736 


b 2 


-0. 020523 


h 


2. 69723 




{-0. 93007, -15. 389, 2. 3720} 



[0293] mm 
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m 
m 



* 


0. 50 


0. 50 


o 


0. 68803 


0. 68803 


o 


0. 039934 


1 


1 


<\ 


-0.83867, 0.0} 


-0.83867, 0.0} 


0.0, 0.0} 


60786, -0.78769} 


60786, -0.78769} 


0.0, 0.0} 


1.0, 0.000} 


o 
o 

o~ 
1—5 


0.0, 0.0} 


+H 


{-0. 54463, 


{-0. 54463, 


o 
o 


{-0.10017, 0. 


{-0.10017, 0. 


CD 
O 


{0. 000, 


o~ 
o 


o 
o 


J- 


0. 063533} 


0. 063533} 


o" 


-0. 53405} 


-0. 53405} 




-0. 98980} 






*Vs 

"< 


54353, 


54353, 


0.0, 0, 


. 59268, 


. 59268, 


0.0, 0, 


,0000, ■ 


1 


1 


I 

<-U-L| 


{0. 83697 -0. 


{0. 83697 -0. 


o 
o 


{0.60291, -0. 


{0.60291, -0. 


o 
o 


{0.14241, 0, 








2. 6492} 


2. 6492} 


0 s 


2. 3720} 


2. 3720} 


o 


0. 0} 


0. 0} 


o 


Si 

u 


-14. 021, 


-14. 021, 


0.0, 0. 


-15. 389, 


-15. 389, 


0.0, 0. 


-15. 905, 


-15. 905, 


0.0, 0. 




.2429, 


.2429, 


o 
o 


93007, 


93007, 


o 
o 


{0. 000 


o 
o 


o 
6 




CNl 


CSl 






O 




















J_ 












m 
* 


u 

* 


m 


* 


CO 
O 

m 


m 


CO 

O 


J* 


flu 




i — i 

Ql, 


<N1 
Oh 


df 
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[0294] (a-7). !&&<D3ij$. 

a-5, a-6lcj: y n^titz/i? * \z& y % £P fr£j£P £^c7)ii£S&l£|£f+ 

s h 

h e 

e s 

x >zl *> p> t i^i c mmx±mx ^ & . 

[0295] &±<D¥5*-e£di**L/=«!&£ia 4 4 Ic^f 0 Halite C$fi±c7>7ti-/KD 

0 s n 

12 3 n e 

3 2 1 

[0296] HI 4 5|z£Pt!>nP> z$ftc7)iEC7)^[6]ANP>Mrsa#I+[o]yic#^j^^»jLfc 

e 

[0297] ja±©¥3*iz«fey 3^tc^p v-r Kfflfft£m*T j r7u*-**f ^<dt|?- 

[0298] <t c 3-e*#BEa>Kst*£ £3i3|-r £ > t°i-^ -eUtrf 

SBRlztt. =i > L° K-r-f X^m^cDMBbBSIfJgESlc^P ? ^ 

A^iLtfc^, ^-r>^^E U-lcp- KLTHfTf £0 ■ecD.fca 

o 
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[0299] B. *nv-< Kffi«£m*fc»MJ»*& 

[0300] 1 . 3&tg? p y-f Kttlft(0£«^4#ft 
[0301 ] (1)3 ;*tu^ p y -f K0>X* 

^py-Y KfiifeSKCIothoid curve)!*. a.— (O^M (Cornu' s 

*ne>;rLTi,^2#;7u<z)>?py-f Kftfgtiu W-M&n (2^7cfi^) (D-a-e 

[0302] mm 

p = p 0 + J'e^ds = P 0 +h J o S e j ^dS, 0 < s < h, 0 < S = < 1 

(D 

2 2 

^ = c 0 + c^s + c 2 s = 0 O + ^ V S + ^ U S (2) 
[»74] 

P = x + jy, j = V^T (3) 
[»75] 

P0= X 0+jY0 (4) 
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mm 

= cos^ + jsin^ (5) 

[0303] fi^lZ^oT;lofcfi^(D^^i=>(7)ft^^s<bL. *<D±& (*&^& 
[0304] ?nv>T Kffl«(D4#»f*. xC(2)r*^Lfc<fca(^ 0A<ffi««s 

0 1 2 

0,0,0 i*-3fc:*<D«»T?*y. :^»tfSIHI©ffih^PV^K 

0 v u 

[0305] J^±<7>Pi££3&7clc&3ILT. 3 □ KE&*£(D:££fF£o 

[0306] 3^PV^ KEB«*KlT<D^-C3E»-r*o 
»77] 

P = P 0 + J o S uds = P 0 + hJ o S udS, 0<s<h, 0<S=-<1 



(6) 





cos j3 


- sin P 


0" 


cos or 


0 


sin a 




T 


cos (3 cos a 


u = E k/7 E ja (i) = 


sin /? 


COS /? 


0 


0 


1 


0 


< 


o> = 


- < sin p cos a \ 




0 


0 


1 


-sin or 


0 


cos a: 




^0 


— sin a 



(7) 

a = a 0 + ajS + a 2 S 2 (8) 
/? = b 0 +b 1 S + b 2 S 2 (9) 
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[»78] 





X 




x 0 




y 


>, P 0 =< 


yo - 




z 




L z o, 



(10) 



[0307] ui*^Pizfcit^fi^^^[S]^^-rm<i^^ h/u-efcy. seam^oT 

5-7Ll>foZ>o ]£(7)|zfc^-C. E k ^i;E ja li|plfeV h 'J^X-t?fey. El 4 8 |Z 
^^^-Scfcaiz. ^ft^tu k$ft (z$i) ^Jby(D^Jti8(D[H]$ESt; j ( 
y$ft) *>hy(D^JtQf(D[l]$s^*^Lr^^o M#^a-(yaw)H]$E> 
tf^(pitch)|n]3te<hl^o iC(7)l*. i ttl (x$4) ^ [r] O HU£. 
^^jlft ( y f*) £*?yict*f£tf-|H]U L^-S(7>*>lck|fi ( z fill) £;fc>yic 

[0308] f&fr*,. 2^7U0)^(^ telfiHDtmJjfo&mfm®-^ MUe j *(£. x 

x y¥®-e#L^2&7n^Q V-T KffiUt^tf^tU 3-:B £ ^0/£<!:. xz 

fid s&frlfxmft? Z>t3#L7t'7U y*f hlMbtLS. 
[0309] 3#7c^O V>f KffiUlcfcl^-CI*. ISIR^^ h;U(7>tf ^ffta&tfa-ft 
/S (i^^^iC (8) ^tfit (9) {Z7jk-?& r> lz % ffl^ft^ife S <D 2 ^sEtr-^* £ 

a>^bl=5Stttt*l#f=-B:-5ct36<prllHc«j:*o 

[0310] ici±<Dj&iz&^x7jkLtz^t <. 3^tc>?p v-r Ka^i* rt^^[p]o>e 
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[0311] P ^bfe*§-O0)3^PV^ K-t^>hli, 

O 

[»79] 



a 0 ,a^,a 2> b 0 ,b l ,b 2 ,h 



(li) 



O 2 

[0312] 3^n V'T KftSOHIW^i: Ltli, H4 9lzjj*£;h,&<fc5fctt 

[0313] (2) ifaflMi 

:£(7)|CfclvC. **&«*Ir]'<* HU i ©fty(3**JS«IS[ i , j , k] 
ZttA-tZk* &G>WRm (moving frame) E£f#§ 0 
[0314] [»80] 



E = [u v w] = E k/? E ia [i j k] = E k/3 E ja [i] = E k/? E ja 
cos p cos a — sin /? cos j3 sin a 

sin /? cos a cos /? sin J3 sin a 

- sin a 0 cos or 



(12) 





cos /? cos a 




- sin /? 




cos /? sin a 


u = < 


sin /? cos a 


% v = < 


cos ft 


% w = < 


sin p sin a f 




- sin a 




0 




cosce 



(13) 



WO 2005/083537 



80 



PCT/JP2005/002132 



[0315] mmmtf±a-e&ibz*i&tzib^ wim&mmrf&^-tev . a 
$&<DMtf;mmm% ^ x* $ & , 

[0316] £fc. E ^fflL^T, P/tf-/ h<DJLM&<Dmm&#.lsb&^ttfV£. ntfy 
[0317] ECD^SS^fii^^^E , E t^r 

O 1 

[^81] 

E 0 =E kb °E ja ° ( 14) 



[0318] (3) P — 'J>>f 

»rtHi£#xrr£c£|z t *:oT. 3o|fl)|51^ rp— /Kroll)j ^t&^c^ 

tfv£& 0 p— /n*^^[S]*^y<z>iHife-efc^o p-/kd#^i*3^7c^ 
[0319] p-;uin$E^#J*-r^<b#> MSMtteTst^fcSo 



E = E^E ja E iy I = E k/? E ja E^ (i 6 ) 
[0320] p-;u^ri3o^rt. c*L£Scailli&£ Lr^-T^c £#t*#£„ 



E _ E k(b 0 +bi +b 2 )gj(a 0 +a 1 +a 2 ) 



(15) 



mm 



mm 



y = c 0 + CjS + c 2 S 2 



(17) 



[0321] 



(4) 3&7C*PV-< Kffi«©»fa3&WttH 



[0322] 



(a) 3 #7u? PV-f Kfflf£(D&fg 
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[0323] [ft84] 



n 



u 



u 



(18) 



[0324] CC"^ (7)ie<fcy 3^tc^P V-T Kffilitt&l&K* h;KDlSfctt#f*TSB 
[»85] 



u'(S) = 



'- a' (S) cos /?(S) sin a(S)+ /?' (S) sin /?(S) cos or(S) 
- a' (S) sin /?(S) sin a(S)+ /?' (S) cos /?(S) cos a(S) 
-a'(S)cosar(S) 



|^(S)|| - ^a'(S) 2 +j3'(S) 2 cos 2 a(S) 



(19) 



[0325] f^*>. 3^7U^Py^ F&mO&m^O h/U*. S£ffll^TTlB(Z>ffre 

H£ft<5>o 

[&86] 



«s)=^ S) 



K( s )| 



Va'CS^ + ^CS^co^oCS) 



- a' (S) cos /?(S) sina(S) - yff* (S) sin ^(S) cosa(S) 

- a'(S) sin^(S) sina(S) + ^'(S) cos ^(S)cosa(S) 

-a'(S)cosa(S) 

(20) 



[0326] (b)IU$E£m^3#7c<5?ny-r Kl 

IS] (1,0,0) ic^tlt. tt«H***iR]£j£8[r£m*T (0,cosr,-sinr) -e 
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[0327] [»87] 



n(S) = 



cosctr(S) 0 sina(S) 

0 1 0 
-sinar(S) 0 coso;(S) 



cos AS) -sin/?(S) 0 

sin J3(S) cos J3(S) 0 

0 0 1 

-sin ycos /?(S) sin a(S)- cosy sin j8(S) 

- sin y sin j3(S) sin a(S) + cos y cos /?(S) 

-siny cos a(S) 



0 

cosy 
-siny 



(21) 



[0328] (20) (21) <Dtttic.m?Z>£. sinr, cos r l*TfBlc*tj& LXl^Z C t 
[»88] 



siny = 



cosy = 



Va'(S) 2 + J3'(S) 2 cos 2 a(S) 
^'(S)cosa(S) 

V«'(S) 2 + /?'(S) 2 cos 2 a(S) 



(22) 



[0329] (c) 3#7c? □ V-T K IS fell- If £ mffi&V(D&&&ffi 

) «ty. 

[&89] 



tany = 



a'(S) 



/?'(S)cosa(S) 



(23) 



[0330] (d) 3#7u?n V-< KttlSKM^ 
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mm 



*(S) = 



P'(S)xP"(S)|| [ u(S)xu 



(S)| 



u'(S) 



(24) 



|P'(S)|| h 



h 



[0331] 



(19)5^^ ffl^l*. 



mm 



*(S) = 




,2 



COS 



2 



h 



(25) 



[0332] (5) 3^7t^o V-T KfiJ^CD^ 
[0333] (a)fi^(^ai^14 

-o^d v-r K-tr^v > h (i^i-cD/^^^-^-e^^n^^p v-r k 

2 LTf#£ft£ffi^fi*gfi^igfcS |z|If] Ltl^tfe§ d £#l£IiE£ 



[0334] (b)J@JE14 

[0335] (c) gUM^ <h (D^^tt 



WO 2005/083537 84 PCT/JP2005/002132 

ca><fc3ic. mis - nam - gEM^ic^-oTis^?- h£^* 
-c»iy»5(&si*fc<* h^ffi^-ci+WLfcy. wj»Lf=y 

[0336] or^fcl*y5(7)l^-r^^^^|-0 <bS< CtlC.toT, 2^PV 

[0337] Etic*a£;h,Ti,^2&7E^o v-t K£^#>t. ngn^m«fci? 

[0338] (d)HiIL0>Ji£ 

v*r Reason*. e^T^^^a-^w^tL^e+L^jg^-r^ctiZcfcor 

[0339] £fc. ^ P V-T KA&£ Lra^L/citiMlc^S ■ ■ ft^(Dfll 

i*» -r&fr*.. ft^/^^-^siz^rc&Lr. (7), (20)&t/(26)xC(c^-r 

Jfi-r*ftffiftiJ1»*S:ic#t>«)-C*S!i<i:1#tt-C*-5o ^O^irl^ot, 

[0340] Nciaxicfc^r. x^«i»a>*/hffl¥^sr*a5i&pgjB-c*y. 
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[0341 ] ( e ) mmmmo)** y ^ $ 

[0342] (6) ffi«<D±j*£:#/<7*-*<Dtt* 

'So 

[0343] [*20] 











h 




a o> b 0 




a l5 a 2 , b 1} b 2 





[0344] 2. 3^7C^PV-r Kffi*fc«fe^tltra^ 

[0345] (1) mzfrmmom^ttmft 
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[0346] 2*tf>3;*7u^i=i V-T Kffl^^0>5M^-e;f ^)7!)^lc^Ii^^t^r^^^^<i:[* 

[0347] mm 

P Xi (l) = Px i+1 (0) 

Pyi(i) = Py i+ i(0) 

P Zi (l) = Pz i+1 (0) 
ai(l) = a i+1 (0) 

A(i) = A + i(0) (26) 

tanvi(l) = tany i+1 (0) 
^(l) = Ar i+1 (0) 

[0348] Z*Ui, Mjl-eii^'? MU^&fSl"** h/K fi^irof. 0 

[0349] [ft93] 

P Xi (l) = Px i+1 (0) 

Pyi(i) = Py i+ i(0) 

P Zi (l) = Pz i+1 (0) 
cos[ai(l)-a i+1 (0)] = l 

cos[A(i)-A + i(0)] = i (27) 

tan7i(l) = tany i+1 (0) 
*r,Cl) = *i + i((0 



WO 2005/083537 



87 



PCT/JP2005/002132 



[0350] cc-e££iz % 
[»94] 

cos[aj (1) - a M (0)] = 1 

[*95] 

tanyi(l) = tany i+1 (0) 

[0351] [ft96] 

tany^l) = tany i+1 (0) 

«'i (1) _ gj±j (0) 
^(1)008^(1) /F i+1 (0)cosa i+1 (0) 

•■• a\ (1) An (0) = a\ +l (0)J3\ (1) 
[0352] IgSTIBtD^ft^tc^aW^a^t-^^^A^aiJfcS^^^JhA^o 

mm 

P Xi (l) = Px i+1 (0) 

Pyi(i) = Py i+ i(0) 

P Zi (l) = Pz i+1 (0) 
cos[ai(l)-a i+1 (0)] = l 

cos[/? i a)-A+i(0)] = l (28) 

«iWi + i(0) = af+i(0)A'a) 
S r i (l) = A: i+1 (0) 

[0353] (28)ieicasi^T. »#Jtf> 3 SC(4tiS<Djfil*tt. ^© 2 Sttft«^lRl<DjHJt 

atSJEPMH^fT^iztt. 2*a>3*7c*nv-r (28) aa> 

7 oa>*f*s*sifcf iMfctffc*. 
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[0354] G z &m (G(*Geometry(D^^) lcoi^T*iSf£o HI 5 O (*G 2 jg^& 
[0355] G 0 Mili2*(D3;^PV'r Kfflf&#*(D^j£TH£S#-Sfc-f £ d £ 

[0356] [£21] 



C 0 : 


G 0 : $lM- 


C 1 : -ifc»5MSSfe 


G 1 : 


c 2 : 


G 2 : ^EfexpS(^), ft* 



[0357] 2*(D3#7c^n V-< Kffi«0>$it*te£#*.fc:£*ic* C°^C 1 ^c\ G 
°^G 1 ^G 2 |c&£|z Lfc*<oT«H*#j&<iK L < fc£o C 1 £«E-e(*&|&a> 

[0358] G 2 51tt-ettfttti™ ^-Si^-ar^o Sf«™i:I*B5 Uz^3?*l 
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[0359] (2) UttftfctW^Jie 

[0360] (a)ffif§<D/«7.*— *h. or, /8 £#*T, 1*fl)3^PV<1' Kl&fft€Jft£ 
£-fc!\ ^-(DiM^-e. (28)^C*3tfc-rckdf^©3^7c^P Kffilft©/^.* 

wmizmmv&v. cti&MMtw&o ^(Djj&iz&tut^ m*mm<om 

[0361] (b)^6b^l££htz&mtf&m(D&m:&ttj:&£.?\Z^ 3&tu*PV-< Kfi 

(28) a&mtz-t cfc a icffl^/^ * ss+ir^ieii* (a) j= y **re& 

y. ttyiBUK3fcttir£:£<&, ccDt+^jii^, j*Kt*fr3^&«(=fti»/<^ 

[0362] ±lB(b)0>iS#|::oi*T\ I+Jt¥;£ £l¥*ffll::sEiz!|-f £<> #< "^B+jrHBI* 

J&3fc*#: (28) fc£LM«(D-gG 
[0363] R#**i*HBI=Jfci:T, ft3fc*tta>»ll«<b U ^ftlcMlir ^ifrcDES]*!! 

m^3#7u?pvr Kffl«o>»*»iu=«fey«9^Lr. *fj£-r***nfflift 

[0364] ±|B0>«iyjSLJK*fi-**3e3£fzJRm*1±*fc«)(3j*. f+Jti^X^ifc 
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£-e*£o ttwommzmi. mM&misb&tzfoiz^ **a/^y-$izoi^ 

[0365] fc§lM*. 3tfc-T^#ttl^fr*-*fc»fc-rO!>-ef*«i:<. 

^(D#ni^^a)cfca^Ho(DSTEPic^itT. in^nfT-r^c hist 

EPi LT&iSfliai:l**^lRlA<-»-r*«feaf=«raLfc«-C. $2STE 
P<h LT&tt*|fi] 5 U:«H£mv i3STEPti$t-|l 

[0366] ( 3 ) 3&7t5 uvj Fmm&m^tzffir&jkonmm 

[0367] (a)ffl&£<D%Lti 

^^3^tu^pv^ Kffi*tnft;. ^*t^«jiE-r-g»mfeffl^^3^7c^pv 

[0368] 3^7c^ P V-T KW B 1(D»*(D^<b Ltli, ttH»fca>]£ilffl£*6#3& 
tc^pv-T K^yV>h<D&/^*-* U JK$U:ttlI9]*t&a>£ 

irk ji^i^xi;a$^-at^ct^^9o 

[0369] (b) G 2 g^&M^tf>3M*F 
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[0370] fgi|i|z3oa>£P={ Px, Py, Pz}, P={ Px, Py , Pz}, P={ Px, Py 

1 1 1 1 2 2 2 2 3 3 3 

3 

o m54ii^p, p, P(D3^tc^p v-r K«ra*^-r, j&p, pra$ig&tti& 

12 3 12 
1 2 3 2 1 

£>/^^— *a0, a1 , a2, bO , b1 , b2 , h „ ffiHC <D/^* — *a0 , a1 , 

1111111 2 2 2 

a2, bO, b1 , b2, h <DUmt §So J*l&lfclElc-eT < ^^(D+f-^X 

2 2 2 2 2 

[0371] cc-e^izMr B im<D^^jiy. ^oG'^^^^cfc^^^^^^o 

^^lCfca^r[*^lC^m(D^^^i^<^:L^a^#[*3^7C>^□ V-f 

^fcHj&icoi^ri*. j^P 2 t:ii{iSizoiNr3o(D3li-efe^ 0 ei±*yftfrSC 

3Elcfci\-cf*. mVm&OfflSi*? h;u£-^*.. j^5Sj£icot^-C2o-5o(Z)^ 

**^-r*tJia0 it b0(*. ^(0^*5Ccfcy^i6^C<b^-C;^^(D-e**n^<i: L 

[0372] £?\ fiffi(7)^I^OLNr#^^<b. (1-1) (1-2) (1-3) 5£<fcy. TlB£> 
3o<D*^y:&0 0 (WTlMi<3^tl>o ) 

[0373] mm 
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Pxj + hj j£ cosCaOj + alj S + a2j S 2 ) cos(bOj + bl ; S + b2; S 2 )dS - Px i+1 = 0 

(1-1) 

Pyj +h; fcosCaO; +al i S + a2 i S 2 )sin(bO i + blj S + bljS 2 )dS - Py i+1 = 0 

JO 

(1-2) 

Pzj +h i fV-sinCaOj + alj S + a2j S 2 ))dS -Pz i+1 = 0 

JO 

(1-3) 

[0374] mmijfaiz'D^x^z.&t d-4) d-5) (D2 0(Die^y3to 0 

[*99] 

cos(aOj +alj + &2 { - aO i+1 ) = 1 (1-4) 
cos(bOj +blj +b2j -bO i+] ) = 1 (1-5) 

[0375] fi^/ccD^^^lzoLNTI*. %.<Dj&a-6)&mi>)±L'D 0 
[&100] 

/q(l)-/r i+1 (0) = 0 (1 - 6) 

[0376] fkm^m5\p\^ h/UnlcoLNT#^-l)o T&TtVuy^ Kffljg(D^«K 

1 h/Unli, (21)iC-ea$Mo 
[0377] CC-(?3^7C^P V-< KffltgCD&H'** HUu(D&^<t li^ilzlIliE^m^T 

> j**"** h/Un£#*-C<?*£o *0«^^Ir] (1,0,0) icfcfLT, #J»J;£ifc§ 

Jjfo&JZWir&m^x (0,cosr,-sinr) -e^f tt«, 

£ a Ci0$E£-fe!:£ £ . ^nliiC (1-7) <D«fe 7 lc^$^-5> 0 
[0378] [»101] 
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cosa(S) 0 sina(S) 

0 1 0 

-sina(S) 0 cosa(S) 



cos /3(S) - sin j3(S) 0 
n(S) = sin^(S) cos/?(S) 0 

0 0 1 

- sin y cos /?(S) sin a(S) - cos y sin /?(S) 

= < - sin y sin /?(S) sin a(S) + cos y cos /?(S) 
- sin y cos a(S) 



0 

cos y 
- sin y 



(1-7) 



[0379] (21) (1-7) j£&itm.i-&t. sinr, cosrl* (1-8) ^Ic^ffc LTL^' 



sin y 



cosy 



V«'(S) 2 +^'(S) 2 cos 2 a(S) 
/?'(S)cosa(S) 

Va'(S) 2 + /?'(S) 2 cos 2 a(S) 



(1-8) 



[0380] o£ y . it (1-8) <*: y . 3#tu? P V>T Kffil!mzfcM*$ft|*j6T?<DSslftiil* 
[^103] 



tan y 



a'(S) 



/?'(S)cosa(S) 



(1-9) 



[0381] o^y;±^ig^-efc^^li. sC(1-10)-C!fc^Z<b:^3!)^< 
[^104] 



tan/iO) = tan/ i+1 (0) 



(l-io) 



[0382] 

[|fe105] 



cos[«j (1) - a i+l (0)] = 1 



(l-ii) 
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C t ^#JtlcL^^ tmftA (1-10) It. TfB0>*tt3t (1-12) X*m$& 

[0383] [^Jt106] 

«'i (l)^'i + i (0) = (0)/?'i (1) (i-i2) 

[0384] &±&-£ttoztm&i~tor&m*o&&My* fr-Dtfmmttaz&vtemft 

l£&m&X*ltl£ (1-13) (7) 3 \ztt& ^ttfi-hfr&o mtz. ■ 

[0385] [»107] 

PXi(l) = Px i+1 (0) 

Pyi(i) = Py i+ i(0) 

P Zi (l) = Pz i+1 (0) 
cos[aj (1) - a i+] (0)] = 1 

cos|#(l)-A + i(0)] = l (1 " 13) 
a[ (m +l (0) = af +1 (0)tf(l) 
^i(l) = Ar i+ i(0) 

[0386] J^±cfc y „ 7k*nifra1 , a2 , b1 , b2 , h , aO , a1 , a2 , bO , b1 , b2 , h 

1 1 1 11 2222222 

3 

3 3 

[0387] [gfc108] 
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Px 1 (l) = Px 2 (0) 

Pyi(i) = Py 2 (0) 

P Zl (l) = Pz 2 (0) 
cos[« 1 (l)-« 2 (0)] = l 
cos[A(l)-/? 2 (0)] = l 
«'i (l)/?' 2 (0) = a\ (0)/?'! (1) 

PX 2 (1) = PX 3 (0) (1-14) 

Py 2 0) = Py 3 (0) 

Pz 2 (l) = Pz 3 (0) 
cos[a2(l)~a 3 ] = 1 
cos[/? 2 (l)-/? 3 ] = l 

[0388] C*ve*£ni&1 2lilCOl^T1 2mO&t><J&<>)±L'0<DX*M : £#itbZ>^trf 

[0390] 0J*f*V1^<7>£Wfc£<*:£. N1@£>**aifc£: NflKDP^sCM U ioi 
hP ,P^PV^K/^7^-^a0, a1 , a2 , bO , b1 , b2 , h <£>70j^i§ 

n-1n nnnnnnn 

x-So ^friCi*. J£^j5^t><!:oii*_&0)-e£P tH£SI::oi^t3 

n-1 

n-1 

[0391] n = 3-eii^»]ilc. ||^^e<^^,lz12fli-efe^^<^*^^o-cl^^3!^^^ ) . n 

**D^(*7 (n-2) +51IU ^tll-ttLXmy+L^t 7 (n- 

li<7> £ &&m<Dm-£ 1 3j£a>ii^<h -efi?£*#>£ c t ^nTt£-efc£ 

„ fi?>4<bLri*. ^mtmi^omizit a -15) (1-16) £®Hft*<j&i;&: 
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[0392] [ft 109] 

AF = [j]Au (i-i5) 
Au = [j] _1 AF (i-i6) 

[0393] j^±«fey, nm<D&m\~KLx*>mm^m$*i&<r>&&My, fr-itfrnrnt 
& & <fc a ^3^7u^ □ v k«h *<fT* * - <t <§> , 

[0394] (c)*D*itt<DftJ£ 

[0395] 5fefrW^E-C**3D Discrete Clothoid Splines!*. jN£&(zMHttfej£$ji 

?&:r=4(Z)3D Discrete Clothoid Spl ines^/K'J =f>Q£fF U . ^^^b 
[0396] CCT*3D Discrete Clothoid Spl ines[coi^T ; ii5Llft0J"?'<5>o 

**L*«k5f3*r. *in»*©jisi5>j*iijisii-r*M»p*fty. po>#ti£ 

IIM=EI£ftrfl^o*rfcfcmjS*#AU PcQ£fc*<fc5«i:M»Q*ffc*o 

T^^it^-er(n-1)+11i(DlI^^t#OC<blz^^ 0 U^h£& 
j5^<o(7>iIL#-5§-<!: Lt, ^TI^^qi-e^-Tctlz-r^o &tz. #TIj£lzfc 

[0397] CKDt^. TE(DlIjai^±A^ffi«t(Z3Ej:-5<fed'S:S:( 1 -17)£g|fcU ffl 
-mcDMWL&m'Mt-t&t&CD) tK'J =f>Q£ 3D Discrete Clothoid 
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Spl \ nest W5 
[0398] [ft 110] 



<li I = Ri+i <li I » 

r-l 



z 

i=l 



A 2 k : 



ir+1 > 



(qi^P) (i-i7) 

i = {0...n- 1}, A 2 k; - k M - 2k; + k i+1 



(1-18) 



[0399] 3D Discrete Clothoid Spl \nesVl£&~m.&(D7 U**i4<t Trlc^^oT 

0 0 

0 0 

[0400] [ftlll] 



cos/?cosa 
u - <; sin (5 cos a 
-sin a 



(1-19) 



[0401] 3D Discrete Clothoid Splinesli. TIj&7!>^Sggf£lcMA/-ei^& C 



4i+1 



4(i+1)-1 



<Djt(i-20)^yiz:o o 

[0402] [»112] 
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a0 4i +^-al 4i + 



a0 4i + — al 4i + 



f i V 



4 J 



a2 4i - a0 4i+1 



a2 4i - a0 4 ( i+1 )_ 1 



(1-20) 



[0403] Z(D5*l**»]ftj5<a1 <ta2 (D2^7U^±L^SxClc^or y . Z*l£#l*T 

4i 4i 

12 12 

[0404] «£*»»l*ffl«:fthT?&*j&<. C0)^fifiO^ri*3^7c>7 P V-T Kfi^ 
[0405] [»113] 



^a' z +j3' 2 cos 2 a 



(1-21) 



[0406] C(D^^»-r^<biC(1-22)|z7£j:y. h(D*D#Jfit*>^££*i£< 
[JR114] 



h 4i = 



7(al 4i +2a2 4i ) 2 +(bl 4i + 2b2 4j ) 2 cos 2 (a0 4i +al 4i +a2 4i ) 



^(i+i) 



(1-22) 



[0407] j^±(7>^±-e7o<D3^7c>7 p v-r K/^^-^ico^r^^it^^-r^ 

[0408] (d)fflHtil 

HI^(cfel±lc^fc^-e^J^MF B TLf=«ll<i:Lr(0.0, 0.0, 0.0), 
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(2.0, 2.0, 2.0), (4.0, 0.0, 1.0), (5.0, 0.0, 2. 0) <7>4j££3&7E? P V-T 

[0409] $€>fc«2 2(z^ffl«0>/^>-^*. £^3I2 3|C. #8N*£-e<Dffi* 
[0410] [*22] 

05= -0.657549 - 1. 05303S + 1. 84584S 2 

j8= 1.03297 + 1. 29172S - 2. 55118S 2 
h = 3.82679 
P 0 - (0. 0, 0. 0, 0. 0) 

a= 0. 135559 + 2. 18537S - 2. 69871S 2 
j3= -0.226655 - 3. 15603S + 3. 03298S 2 
h = 3. 16932 
P 0 = (2. 0, 2. 0, 2. 0) 

a= -0.377569 - 1. 45922S + 0. 984945S 2 
/3= -0.349942 + 1. 32198S - 0. 873267S 2 

h = 1.43987 

P 0 = (4. 0, 0. 0, 1. 0) 



[0411] [^23] 
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Coord: (1.16xl0" 5 , 2.00 x 10" 6 , 3.82 xlO" 6 ) 
Tvector: ( 7.59 x 10' 5 , 1.50 xlO" 5 , 2.95 xlO" 4 ) 
Nvector: ( 2.93 x 10" 4 , 9.19 x 10" 5 , -7.57 x 10' 6 ) 
Curvature : 3 .06 x 1 0" 7 

Coord: (-4.33xl0" 6 , -1.64 xlO" 6 , 1.11 xlO" 5 ) 
Tvector: ( 2.06 x 10" 6 , 2.33 x 10" 4 , 1.97 x 10" 4 ) 
Nvector: ( 3.30 x 10" 4 , 1.19 x 10" 5 , -3.23 x 10' 5 ) 
Curvature: 5.96 xlO" 6 

[0412] (4) mmztei+&&m<Dmffl$:mj£LtzG 2 mmtj:3%.7t<7 n v-r Kutra 

k>&3%.7L<?n V-f K^^co^TifeSDil&lia , a, a, b, b, b, h(D7ofc 

0 12 0 12 

&0>-C:\ *ft]tlc[*^-e7(n-1)1ife^^<i:lZ7£i:§ 0 ^frieico^TI* 
. n-2flife^Jt^-<i:[cJS^. &«L ffi^(D711|-3o<!:$§£|zfclt£ 

J^(D3^#£-f§ ^Sp-e7(n-2)+31@-Cfc^ 0 (3) Ufcil ft 

[0413] ::t% • $t£lcfc[-f£1£f£ ■ ■ fflip£»PU froG 2 ig^<b:&:£ 
• m&X*m$& ■ ft>lMzo^T2^o*0(D^S+4^iix&C<tlz£:^ 
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[0414] *^x\ ::tit ffiffltt&&&mzizm\-?&^t\z&^xm%\mkm 

[0415] ^(Dm^m^^2-Dm^^(Dx\ &mm&\z-D^miwmm. mm. mm 
. mmom^-Doumm^^o -fix. **n§&i*3&7c* o vr ra##2o 

ii3.£tf>-e. a, a, a, b, b, b, h(7)7o-50(D^a+14H<D**DlWi§;*.§ 

0 12 0 12 

ctic^-& 0 z<Dt£&mz^&fr%&(Dm3in+2mv$>z>frib. ±&xmz- 

[0416] *6)fc-ttfl<iJ£c»^(zo^-C#A«o nffl<Dj5*"J£«lffl-r££:#* Mi At* 

jiSi5iJ(*n-1fi<Dffi«-etltra*Jfi-6o tU JK*lc«.ji5i£jiS£j:S>fc32fc7G 
^nvfKI8»i:o^r*ttfttta, a, a, b,b, b, h0>7ofc£(D-e. 5fc 

0 12 0 12 

»fttt^(*-C7(n-1)flft*Ci:lZ3S:-5. ftfrSClzoHTIdu n-21ifc£ 

^^-<blcjS^l s fl¥(D7fli-5o<b$|^lzfc(t<SJSM(D3fli^ 
#£f ^»1?7(n-2)+3fi-e*y. ftttiCa^AMo^fcl^o o£y. 

^liffi^fct^r$lJ^]$H^^<^IlSli4om±<^t^a-<blZ^t^ 0 felT. »W + 
■eral*4l2l±(Da«Sa. kf*2&±e*S»re&££LT\ Hrfclcj^^^ALfci: 

[0417] (i) m=2k<D<i:£ 

M4*-C*t>-B:rm=2kfia)flia**iJ«i-r«^*. *ftlftl*^:{*-e7(n-1)fl. 
grtt "C 7 (n-1 ) -4+2kli X >tb £ » - 0) <h £ £$f iC l*2k-41i X £ 
o k-21@(Dj££irfclc^Air£c 3&7G*nv<< K«#j&< 



WO 2005/083537 102 PCT/JP2005/002132 

k-2*. 8tmj5L&k-2mmz.&<DV* **n»I*^fr-C7(m-k-3)fi. mi*&lt± 
#-£7 (n+k-3) -4+2kfi£fc£ 0 - zt* 6(z«ffc|z#A Lfc#^(DJ^4I(Dflt(D 
?*>2o («7L«x.y) £**aife<t LT&^f &<t. *ttft(*^:<*:T! 
7 (n+k-3) +2 (k-2) ffl. ftfrSCtt*#-e7 (n+k-3) +2 (k-2) mtteV 
j£<Dm<WL<tj:Z> 0 
[0418] (ii) m=2k+1 <Dt£ 

. mi*j£lZ±i*Xl(n-V+2k-3mx$>Z> 0 ^Ot &iBffltii$ktt-&\Z2k-2mx 
£o k-1^(D£££rfclc^A1-&c££#*££:. 3#te>7 p v-r Ktft# 
*>*k-1*. lt^^*%-11i±i^^(D-e. *fil»tt^tt:-C7(n+k-2)fi. ^fl^l* 
£&-t!7 (n+k-2) -3+2k<i <h cct^fb icgrfclz^A L t=#jSi©ffi«a>ffl 
(D?*>2o (0ij*.l£x,y) £**nife<t LXtiko£Tf&£, mtomt±KV 
7 (n+k-2) +2 (k-2) ® s mftj£l*±i*X7 (n+k-2) +2k-3fli t & i) jkfti&amm o 
#<^l>c -^ce, m=2k+1a)ii^•|c[i^iAL^^CDa*>l><!:O^DJ^lcfct^r 

ttJS«<oflta>5*iof£it**fti»i:Lrtftafr*o 

m*±i*Vl (n+k-2) +2 (k-2) > Stt^ft-C7 (n+k-2) +2 (k-2) £ y * 
[0420] [«24] 
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4 


0 


0 


0 


0 


5 


1 


1 


1 


1 


6 


2 


1 


2 


2 


7 


3 


2 


lflUCO^ : 1 


. 3 




2k 


2k-4 


k-2 


k-2{@CD,£ : 2 


2k-4 


2k+l 


2k-3 


k-1 


k-2flaco^ : 2 
HB<Z>/£ : 1 


2k-3 



[0421] (b)#;± 

ste P 3) (D&n/i^t-zztommt it, g^^^^tc-Tcfc^^a 

[0422] £IT. #Step|zo^rl5fe0J^MS-r^o £"fStep1 izfcl^T I*. 
$iJ^J-r^(D-e fettle (3)fl)¥l^ffl^tfli$^t5o 

Tl£. (3)(Z>#;£<hl^£^fit£m^o 
[0423] ^lcStep2lcfc^-C§ffc^^^^AL. 3kfttm%\$k<DWL<Dmm&'n? d t 
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[0424] a^lzStepSlcotNT-efe-ST!)^ StepSTfTd -=l— h > ■ =z> Z? V > s &0)tz 

jiti5>Jra*a«ia)*#*}ltfc-rcfe^JS:3^7c^PV>r Kft«-C« 

iw*frofc 0 

[0425] (OilDfl 

□ v-r K*tiwLfc«*js-r. **(=a*^**in»*a>jflif=3iLW*iiy 

. P , P , Pt Lfco 

1 2 3 

[0426] [*25] 





mm 






ft* 


Pi 


(0, 0, 0) 


(cos(e),sin(e),o ) 


(-Sin(0),Cos(6), 0 ) 


0. 2 


p 2 


(4, -4, -4) 








p 3 


(8, -4, -5) 


(1,0, 0) 


(0, -1, 0) 


0. 2 



* 9 = - 



[0427] £KlcffilH£fTo*:t6S£EI6 1 ic^fo 3Uft*<3&7c* n V 
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m.2. efrzfr>fr&&o\z5-Ktzmi*&ffitzLT^&^ttffr>fr&o 

[0428] [£26] 





MS 








Pi 




{0.0, 0. 0, 0.0} 


{0. 8660, -0. 5, 0. 0} 


{0. 5, 0. 8660, 0. 0} 


0. 20 




{0.0, 0.0, 0.0} 


{0.8660, -0.5, 0.0} 


{0.5000, 0.8660, 0.0} 


0. 20 




{0.0, 0.0, 0.0} 


{0. 0, 0. 0, 0. 0} 


{0.0, 0.0, 0.0} 


0 


p 3 




{8.0, -4.0, -5.0} 


{1.0, 0.0, 0.0} 


{0.0, -LO, 0.0} 


0. 20 




{8. 0, -4.0, 5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 20 




{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 



[0429] (d) tpffl&X*<Dm<DMW 

[0430] m^itme 3(D&ote&m&ffimi-&m-£\^te^x, tpm&px&^ 

c 

zmmTtz^tzmx-Zo u&*u ^mx^x^tz^mxit^m^isif 
[0431] -r^*>. /5*ui^*t Lx-m^mzftooxittd; < , ^ihijup £«A/-ea 

c 

1 2 c 

-e (w <D^m &m ^tutm&mwi- * c t *<t? # * «t ? ic & * 0 

[0432] ^0&?\zmmLtzim<DfoZ>&Xm.ft&fti+. ^©Mffllzfclf^flt^ftiJ 
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[0433] (5) wfl&j&-ea>&fSL mm. ffl^^J^Lf=3^5c^p v-r Kin 

[0434] (a)¥&(D3S*l 

[0435] (b-1) ffi|ffl»»<DjSi*-^il* 

C(D0iJ-ei*3^7C^F B 1(D3^{O.O, 0.0, 0.0}, {5.0, 5.0, 10.0}, {10.0, 

10.0, 5.0}£#*fc o ■e<Dffe#£(z#*.fci£fSU &«S> ffi¥fci?<D&fr£* 

i:«)ta2 7lz=BLfc 0 
[0436] [£27] 













Pi 


(0. 0, 0. 0 , 0, 0) 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0. 1 


p 2 


(5.0, 5.0, 10.0) 








p 3 


(10.0, 10.0, 5.0) 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 1 



[0437] (b-2) r=4tf>3DDCS(D£j£ 

^-efe^>3D Discrete Clothoid Splines!*. MttttzfltlH&ftj££aU . fi^ 
r =4(D3D Discrete Clothoid Spl inesO/K'J 3>Q£fE y „ "Z^fr^tiWVfe 

[0438] [£28] 
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Pi 


{0.0, 0.0, 0.0} 




{0. 4677, 0. 4677, 3. 1228} 




{0.9354, 0.9354, 6.2456} 




{2. 3029, 2. 3029, 9. 4966} 


p 2 


{5. 0, 5. 0, 10. 0} 




{6. 7095, 6. 7095, 9. 9244} 




{8.0655, 8.0655, 8.4732} 




{9. 0327, 9. 0327, 6. 7366} 


p 3 


{10.0, 10.0, 5.0} 



[0439] (b-3) *D#Jffi0)fe£ 

*¥;£-ej*^(Dfit^b-2-e^Lfc7K i J=r>Q^or. #5fc*n 

&0>j&Mfe&#1toX1kfe-j-& o 3D Discrete Clothoid Spl inest? I*#Hj£ <D 

iftl»a>ttl»a)*i:(=«fcy. tfu =r>Q©ra£©«fft:£fliHiiiaa. jB*<3ft*s 

0 0 

[0440] [tl[115] 



0 0 



COS/? COS <2 

u = <! sin/? cos a 
-sin a 
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[0441] c:t% 3D Discrete Clothoid Splines!*. TIj&Tb^a^tl^MA/tra^ Z 

4i+1 

4(i+1)-1 

[0442] [»116] 



[0443] Z(DiCli**niJf^a1 <ta2 a)2^7c^3t^fiieiz^or U . C*i£»l*T 

4i 4i 

12 12 

[0444] »£*»ftl*ffi«:fth-C&£j&<. dO)*0»!ffio^rf*3^7c^ □ V-T KffllR 
(Dfi^jCcfcy^tilf 6o 3^tu^pV-< Ki«(Di$li. TfB-ea$jK^o 
[0445] [»117] 



a0 4j + — al 4i + 




4i+l 




h 



[till 18] 



h 4i = 



^(al 4i +2a2 4i ) 2 +(bl 4i +2b2 4i ) 2 




^40+1) 



[0446] 
[0447] 
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tP 2 t 


#0 


o.o (IBs) 


a x 


-0. 2684 


a 2 


1. 0739 


bo 


n/2 (gE*n) 


*>i 


0. 0 


b 2 


0. 0 


h 


12. 7684 






-0. 1648 


a 1 


3. 2061 




-2. 6327 


bo 


0. 7853 


bi 


0.0 


b 2 


0.0 


h 


9. 6752 



[0449] (b-4) B^lc£-££iI<cK G 2 ii^&3;*7u? n V-f KffiH 

(b-3) -zikm Ltz^mm^m^xG 2 mmt ? ^^#Tt§ft«©/^ 

[0450] c:t% 3&<D2#.7i<7n V-f KttHfzfclxr* lcS&(cMF H 1^(D^^jiy 

2 3 12 12 

3 2 11 

. mmc<D/i?*-$a-\ , a2, b1 , b2 , h . ffl^C 0>^z> * —: $*a0 , a1 , 

1 11111 2 2 2 

a2, bO, b1 , b2, h 0\mttnZ> 0 KlftKWlz-cr < ZX^W^X? 'J ^ 

2 2 2 2 2 

$e£k*. Jill. ft**ffi«fiSE»Sa>B8»t LTPx , Py, Pz , a . £ , n 

i i i i i 

i i 

[0451] £?\ ^P/3fcl^r[*^lz^ir H 1^(D^^ii^<^:t^a^l*3^7U^P V 
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[0452] ^izj^P lzoiNT#x^ 0 ^P(*fi^±CD^^-efcy. G 2 5i^lz£:.£>|z 

2 2 

2 

[0453] [2&119] 

P Xl (l) = Px 2 (0) 
P yi (l) = Py 2 (0) 
P Zl (l) = Pz 2 (0) 
cos^Cl)-^^)] = 1 

cos[A(l)-^ 2 (0)] = l 
ni (l)-n 2 (0) = l 

[0454] «&lc£P|zo(,NT#*3o ^PliH^-efey. Jifc-r^^^lifiM. & 

3 3 

]&<DftVfo&<DV>AT<D5'D<DmftrfJ& l ')±'Oo CC-eor s £ 

3 3 

[0455] [^1120] 

Px 2 (l) = Px 3 

Py 2 (i) = Py 3 

Pz 2 (l) = Pz 3 
cos[a 2 (l) - a 3 ] — 1 

cos[^ 2 (l)-A] = l 

[0456] £Lt<*:y. 5fc*ni!ta1 , a2 , b1 , b2 , h , aO , a1 , a2 , bO , b1 , b2 , h 

1 1 1 1 1 2 2 2 2 2 2 

2 

fife y 3to^jCliTfB(D J: ? lc & £ e 
[0457] [»121] 
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Px 1 (l) = Px 2 (0) 

Pyi(i) = Py 2 (0) 

P Zl (l) = Pz 2 (0) 
cos[a 1 (1) - a 2 (0)] = 1 
cos[A(l)-/? 2 (0)] = l 
ni -n 2 =1 
^(1) = ^ 2 (0) 
Px 2 (l) = Px 3 

Py 2 (i) = Py 3 

Pz 2 (l) = Pz 3 
cos[a 2 (l) - a 3 ] = 1 
cos[/? 2 (l)-/? 3 ] = l 

[0458] Z^r^t![12^lzoLNrl21i(D^j|Ky3tO<D^^*to^C<b^-e# 
[0459] [«30] 









m 




a 0 


o.o (gEfcq) 




«i 


-0. 2684 


-5. 4455 


^2 


1. 0739 


5. 4122 


^0 


Tt/2 (gEftO 




*1 


0. 0 


-3. 8590 


^2 


0. 0 


3. 1003 


h 


12. 7684 


13. 5862 


jfePatPai:* 




-0. 1648 


-0. 033258 


*i 


3. 2061 


3. 6770 


a 2 


-2. 6327 


-3. 6437 


£o 


0. 7853 


0. 8120 


*i 


0.0 


1. 6006 


^2 


0. 0 


-2. 4126 


II 


9. 6752 


9. 2873 
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[0460] (b-5) &n<D3iJ$. 

m 6 8 [* (b-4) VJfUsbtz/^ * £tu(c£j£ Ltz&t%t b-2V±l& Lfc/K 

2 

[0461] (b-6) 3H*iC 

1 3 

izftj^C (Dfl^S^ifeS =0. 5£>teSlCj£DP ^Drfclc^ALfco fi3^C Iz 

1 1 2 

ot\ttfl^tl[S =0. 50>teaizj&DP ^Srfrlcif ALfco 

2 

[0462] Z(Dt£. &P t&DP ^^fflj^^ffl^C . ^DPir^P^^ffl^^ffl^ 

11 112 

c . ^p t^DP^^mm^mc % &dp t&p ^^mm^mc t 

2 2 2 3 2 3 4 

. mx.imm\^&if&mm. mmm&fta. p. mm. mm&mm^m, 

(OmWLt LTPx , Py , Pz , a , p , n , k tf>£?lc;ft-f 0 • 

c c c c c c c 

iz^^-ci*. hl ^mfE^of. mm. mmzm&vizpx , py, pz, 

s s s 

a , P , n , a: . Hj&-ei£Px , Py , Pz , a , 0 , n , /c (D& r> Iz^f o 

ssss eeeeeee 

[0463] J^Tlz^lzfc^TJlgyiLO^^fBf o 
[0464] [I&122] 
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j& p, : mm, mm, mm ■. 4 m 

cos[a CI (0)-a s ] = l 
cos[/? cl (0)-/y = l 
n cl (0)-n s =1 
rc cl (Q) = rc s 

5 ^cdp,: tt, mm, mm, mm -.7 m 

Px cl (l) = Px c , 2 (0) 
Py cl (l) = Py c - 2 (0) 
Pz cl (l) = Pz c . 2 (0) 
cos[a cl (l)-a c . 2 (0)] = l 
cos[^ cl (l)-^ c . 2 (0)] = l 

n C'l( 1 )' n C'2(°) = 1 
«T C1 (1) = tC C ?(°) 

^p 2 : um, mm, mm, mm -.im 

Px c , 2 (l) = Px C3 (0) 
Py c . 2 (l) = Py C3 (0) 
Pz C2 (l) = Pz c , 3 (0) 
cos[a c - 2 (l)-a C3 (0)] = l 
cos[/? C2 (l)-/? c . 3 (0)] = l 

n C'2( 1 )- n C3(°) = 1 

jc c . 2 (1) = jc c . 3 (0) 
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j&dp z : mm. mm, mm -im 

Px c . 3 (l) = Px c , 4 (0) 
Py C 3(l) = Py c . 4 (0) 
Pz C3 (l) = Pz c - 4 (0) 
cos[a c . 3 (l)-« c . 4 (0)] = l 

COS[^ c , 3 (l)-y9 c . 4 (0)] = l 

n C 3( 1 )- n C4(°) = 1 

^ c . 3 (l) = AT C . 4 (0) 

&p 3 : mm, mm. mm -.im 

Px C4 (l) = Px e 

Pyc 4 (i) = Py e 

Pz C4 (l) = Pz e 
cos[o; C ' 4 (1) — a & ] = 1 

cos[/? c , 4 (i)-/y = i 

[0465] m±cfcy. £&Tj£y£o^#^«[£32^&§ 0 &&mm 

n y-< K/^.*— £l*a , a, a, b, b, b, h03 7O^otfc^ fro 

0 12 0 12 

(Dj£DP,DP<7>y,zJ^lt£*ftifc<t LT&lV *£nii[£4oii^ Lfco 

1 2 

[0466] (b-7) *D»Hii<£>;*:s£2 

"CI*. El 7 0(7>J:dlc(b-5)-e^Lfc3^7c^P y-f Kfi^^L<*fAL 
[0467] fi^a>^SiJ;±lzo^ri*. ffiflC £ffifgC £ffi«C £lc#HJ-f 

1 1 2 
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mWi-Zt. mm? ©^PV-fK/^^-^' , a' , a' , a' , b' , b 

1 0 12 0 

12 1 d 

[0468] [»123] 



a' 0 


= a 0 


aj 


= a iS d 


a 2 


= a 2 S d 2 


b'o 


= b 0 


bj 


= biS d 


b' 2 


= b 2 S d 2 


h' 


= hS d 



[0469] 2UC#SIJ£DP &ft&f?%mm lzotNT#^^ 0 £lf\ ffl*£C <t*££ 

1 2 1 

1 

-< K/^y— Sth' ' , a' ' , a' ' , a' ' , b' ' , b' ' , b' ' I*. 

0 12 0 12 

[0470] [»124] 

P s " = P(l) 

= a 0 + aj + a 2 + 
aj=-(a,+2a 2 ) 
a 2 = a 2 

b'o = b 0 +b l + b 2 

bf =-(b!+2b 2 ) 
b'2 = b 2 
h" = h 

[0471] ^(D[ftl!a±lc;fc^T#Il|j5DPI*. DP =C ' (1-S)T?$*^, CCtfll 

1 1 1 d 

1 1 2 

2 2 

1 2 
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2 



2 

[0472] ^(D&moiu K/<^*— *h' ' , a' ' 



1 2 0 



[0473] [»125] 



ar = (l-S d ){ ai +2a 2 S d } 
a 2 =a 2 (l-S d ) 2 

b 0 = b 0 + b l S d + b 2 S d 2 
bJ' = (l-S d ){b 1+ 2b 2 S d } 

b 2 =b 2 (l-S d ) 2 
h" = h(l-S d ) 



[0474] fel±a>^>±-e. 3^7C^PV-< Kffi«C±©ft«S*»A<S =0.5-efc6£DP 

1112 2 

±<Dmum^m^s =o.5-efe-s^DP -eft^c ^a^c tizftm^zz 

2 2 3 4 

[0475] C(D^>i-C^llJLfc40(7)ffl^(D/^y-^^a3 1 IzK-t+fco C0)ffi*g(7> 
[0476] [£31] 
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o.o (fE*p) 






4. 9134 




*i 


-2. 7227 






-0. 016629 






1. 3530 






1. 3530 






tc/2 (K*P) 




bo 


0. 41633 


C i 


*i 


-1. 9295 




b l 


-0. 37938 




^2 


0. 7750 




b 2 


0. 77507 




h 


6. 7931 




h 


6. 7931 






{0. 0, 0. 0, 0. 0} 






{1.8431, 3.0860, 4.9597} 






-0. 033258 




^0 


7. 1774 




a i 


1. 8385 




3l 


0. 016629 




a 2 


-0. 91093 




5 2 


-0.91093 




bo 


0. 81202 




^0 


1. 0091 


C 3 


bi 


0. 80031 


4 


*1 


-0. 40601 




b. 


-0. 60316 




*2 


-0. 60316 




h 


4. 6436 




h 


4. 6436 






{5.0, 5.0, 10.0} 






{7. 0029, 8. 1298, 7. 5337} 



[0477] (b-8) ^lWPV-<M7^-^^5 

(b-7) LfclD&fiS^Tclz. (b-6) V±LXtzmfti£&MtzTfM&-=L- 

^(D^ L fc t (D "C § o 
[0478] [*32] 
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u 


0. 0 (g£^P) 




<9 n 
u 


5. 3846 




1 


0. 0000 




a i 
i 


-3. 4602 






-0. 89854 




5 9 


4. 341 




U 


tt/2 (i££p) 


mm. 


u 


0. 47690 


C ! 


1 


-0. 51836 


c 2 


*i 

i 


-3. 2143 






-0. 57552 




bo 


3. 4613 




h 


5. 1836 




h 


9. 9808 






{0.0, 0.0, 0.0} 






{1.8431, 4.1726, 1.4653} 




u 


-0. 017740 




an 


6. 8553 






3. 4572 




a \ 


-1. 1443 




^2 


-2. 8673 




a 2 


0. 57219 


ft** 


bo 


0. 72385 




bo 


0. 76315 


C 3 


bi 


2. 4551 




bi 


-1. 1942 




b 2 


-2. 4158 




b 2 


0. 43108 




b 


6. 60818 




h 


3. 3206 






{5.0, 5.0, 10.0} 






{7.0029, 9.0734, 5.6186} 



[0479] [£33] 











mm 


Pi 




{0.0, 0.0, 0.0} 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0. 10 




{0.0, 0.0, 0.0} 


{0. 0, 1. 0 0. 0} 


{1.0, 0.0, 0,0} 


0. 10 




{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 


p 3 




{10.0, 10.0, 5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 10 




{10.0, 10.0, 5.0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 10 




{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0. 0, 0. 0, 0. 0} 


0 



[0480] (b-9) &m<n$Lm 
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g^-fb/** — >*iSLTl*<&. *fc, 0 7 2IZ07 1 <D*!|(D«!lIlz^]££l± 

[0481] m±-e. mwvtm. >£*§l &m$um Ltz3&7tv □ v-< Kara&K** 

[0482] 3. 3 3fc5c*PV'f KMIH£m*f=fttt1Mtt££ 

[0483] ( 1 ) 3&tg? PV-f K«M*fflt^fcftflt«ltt** 

(D¥Jll5^£>&<5>o 
[0484] (a)Xj|»MlU*a>Ktt (07 3. Si) 

§ 0 PtN7hf©lIA<li<i^, (x^jGu tool center 

point) r*¥iiWft«iM*^rawf=ffi^*Lfc5itt'£ctiu»ffiii (tt«**t?) 

©±*l*IBW(z*»-r-6i:#il-6ci:36t"e#*. JLM&Otemt, mm (x 
Jt-ca**t^, a> <fc ? M & »i # -e xm^a)Mii^tL^tLi3 

[0485] (WSPiSffi^a^Tlitf) (07 3. S2) 
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[0486] **K»tRlzfcl*Tl** «Atf*A««(z«ffl3F*Lr^*«tta>mt^ffi|« 

zfl)3ii^fflL^O< €>4t<5 3^7cj£«l3R-e*y. X^j& (DteS £-f 

[0487] (c)B##£| (07 3. S3) * JU^>7>***l=<fc*X*©tt« • ^ 
|*a>t+# (07 3. S 4) 

m^Ltz<DXu XJIjSiflDtfcll ■ &ft*<i*M t c^BB^ir LT-!**.£>*ifcC £|z 
C*Uz<fcy. B*IBt *«/M*HIBH|-C#il.f=i:#. -tti-e+uDBSSJlz 
jfrr&JLM:&a>&ijL&&it>&ztifiv&&o (cXDW-IH*. JU*Wlzi*J2TFa> 
«fc5lzfr£::b*i*. «ftjft(zfe^rtt. tfcait«-£l£t§* ffi^fc 

[0488] J2l±a>#f*#lz«fcoT\ *iU^*>T>JS«3R (£&ffilfll) lzfclf£B#H t 
fztt*&x*j£©M££fto<fttr£jK<&o ^ife<t Ltl*. 3^7tXlt (x 
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. y. z. A. v. 0) ttZ%> 0 tztzL. (A. u . v . 0) l*§gf*E£ 
^fflfilH$E-C!*Lfct(D-e (A. [*Hfflfi[nl$ECDlft^. 0 [*Ih]$e£i 

to 

[0489] titfltfiJWio^^lZ^y. 3 ^tc^ □ V-f KttHffilllzj&o T > 

<DX\ W%>X$>& 0 
[0490] (d) &»flfffi (073, S 5 ) 

#1^ ±fBtf>xm£<7M£S ■ mm*^x&tz&>\^>&^t£&^<DmKft$:-& 

ib&o ^(D&Ult— (inverse kinematics) tm£*iXl^& 0 

<Dmw. lycomm, ^w<DMMmm$m®&LtzfrvjLm&<D&.m • mm 

-gmoftm ■ mm^^^momune 1 -e 6&j&6b&&<Dx&&o 
G>T<7TzLJL—5nt\E\&=E—' titmz?. v-T^—zmomMT 

[0491] (e)$iJ^^ICJ:^#^-^^ii(Df+# (073, S6) 

^m^^tz^jimmz'D^m.mm^^nsb. (euit 

[0492] ±|B. (a)&Xf(b)ltmffitoti:mMX$>V. -j£f£lt*T&;b*t<&o (c)-(e) 
[0493] ±fB<D£T(Df+Jt£. tfc«lJ^fi£>*-CMT ? d <t t RT^fe V % 



WO 2005/083537 122 PCT/JP2005/002132 

[0494] (2) NCgfiCNCgf 

JUT. ^3t(D^fii$lJ^S (NCgi) ^ffl^-^ii^t. ^P^77© 
&flj£#ofc=l>t:zL-£ <h N CjgS^-M^ftfcC N C=£B£teffl-f 

[0495] (a) &£<DNC^S£m^ii£- 

-f b £ titz £ <7> <!= tt o r L ^ & „ 
[0496] &£a>NC^a£m^i##ICOl^-C. 3^PV^K 
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